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This  thesis  compares  the  performance  and  robustness 
of  colocated  and  non-colocated  sensor/actuator  pairs.  Linear  quadratic 
Gaussian  and  loop  transfer  recovery  (LQG/LTR)  procedures  are  used  to 
design  optimum  controllers  for  three  example  problems.  The  first 
example  is  a  single  motion  degree-of-f reedom  system  having  motion  only 
about  one  axis.  This  type  of  system  does  not  have  any  right  half  plane 
zeros  for  the  non-colocated  case ;however ,  the  thesis  shows  it  behaves  as 
a  non-minimum  phase  system.  The  second  example  is  a  Bernoulli-Euler 
beam  which  does  have  RHP  zeros.  An  optimum  LQG/LTR  controller  can  not 
improve  the  robustness  of  non-minimum  phase  systems ; whereas ,  colocated 
systems  are  easy  to  stabilize  and  make  robust  with  LTR.  However,  this 
thesis  shows  that  non-colocated  systems  can  achieve  higher  bandwidth 
and  performance.  So,  each  system  has  its  own  advantage. 
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Abstract 

This  thesis  examines  the  effects  of  colocation  and  non¬ 
colocation  of  sensors  and  actuators  on  flexible  structures. 
Colocated  structures  are  easy  to  stablize  and  make  robust 
because  they  have  alternating  poles  and  zeros  on  the  imaginary 
axis.  On  the  other  hand,  non-colocated  systems  are  difficult 
to  make  robust  because  they  have  right  half  plane  (RHP)  zeros. 
Systems  with  RHP  zeros  are  defined  as  non-minimum  phase 
systems  and  have  traditionally  been  avoided  in  control  design. 

The  thesis  uses  linear  quadratic  Gaussian  and  loop 
transfer  recovery  (LQG/LTR)  procedures  to  design  optimum 
controllers  for  three  example  problems.  The  first  example 
studied  is  a  three  element  single  motion  degree  of  freedom 
(DOF)  system  analogous  to  torsional  or  longitudinal  vibration 
models.  Because  single  motion  DOF  systems  have  motion  about 
just  one  axis,  they  have  no  RHP  zeros.  However,  this  thesis 
will  show  that  indeed  the  non-colocated  single  motion  degree- 
of-freedom  system  behaves  like  non-minimum  phase  systems. 

To  model  structures  with  RHP  zeros,  a  finite  element 
model  of  a  Bernoulli-Euler  beam  is  investigated.  LQG/LTR 
controllers  are  designed  for  the  colocated  and  non-colocated 


x 


systems.  Then  the  closed  loop  systems  are  compared  for 
performance  and  robustness.  Finally,  a  three  dimensional 
finite  element  model  of  a  Contraves  P52F  gimbal  structure  is 
analyzed.  This  third  example  has  significantly  more  complex 
plant  characteristics  than  the  previous  two  examples. 
LQG/LTR  controllers  were  designed  for  this  commercially 
available  structure.  The  results  from  the  different  design 
iterations  show  that  non-colocated  structures  although  they 
may  not  be  robust  can  achieve  higher  performance. 
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EFFECTS  OF  COLOCATION  AND  NON-COLOCATION 
OF  SENSORS  AND  ACTUATORS 
ON  FLEXIBLE  STRUCTURES 


I.  INTRODUCTION 


Active  control  systems  will  be  required  in  the  design  of 
Large  Flexible  Space  Structures  (LFSS) .  The  future  space 
station  is  a  good  example  because  it  will  likely  consist  of  a 
rigid  central  hub  with  flexible  beam  appendages  surrounding 
it.  These  beams  will  have  many  low  vibrational  modes  as  a 
result  of  maneuvers,  motion  of  mass  within  the  structure  and 
docking  procedures  [12:521].  Because  such  low  density 
structures  have  little  damping,  the  control  system  must  dampen 
out  these  vibrational  modes.  Furthermore,  the  control  system 
can  help  increase  the  size  by  allowing  lighter  and  more 
flexible  structures  to  be  built.  However,  the  low  mass  and 
low  frequency  modes  of  such  structures  can  cause  problems  in 
keeping  it  stable. 

Not  only  is  the  low  vibrational  modes  of  the  structure  a 
problem,  but  physical  limitations  will  govern  the  location  of 
the  sensor  and  the  actuator  pairs.  Ideally,  colocated  systems 
are  desired  because  stability  is  easy  to  achieve  using  simple 
control  laws  as  shown  by  Gevarter  in  1970  [3].  Since  that 
time,  most  of  the  control  theories  and  designs  have  been  based 


on  using  colocated  systems.  But,  frequently  on  space 
structures,  physical  limitations  prevent  colocation.  A  recent 
example  is  the  Galileo  spacecraft  launched  by  NASA  in  1989. 
It  has  a  separated  actuator  and  sensor  pair  which  made  it 
difficult  to  control  a  television  camera  and  other  instruments 
(sensors)  located  at  the  end  of  a  flexible  beam  [4:1].  This 
beam  had  four  low  frequency  modes  below  the  required 
bandwidth.  To  meet  the  performance  specifications,  the 
controller  designed  by  the  Jet  Propulsion  Laboratory  had  to  be 
supplemented  with  a  slewing  manuever  to  minimize  vibratory 
motion.  When  possible,  the  sensor  and  the  actuator  should  be 
colocated  for  ease  of  control  design. 

In  some  cases,  as  stated  by  Thomas  and  Schmidt,  it  is 
better  to  have  non-colocated  sensors  and  actuators  [12:521]. 
Sometimes  the  sensor  must  be  placed  at  a  node  which  gives  the 
most  information,  but  where  an  actuator  can  not  be  placed.  A 
good  example  (given  in  Reference  12)  is  placing  a  sensor  at 
the  tip  end  of  a  cantilever  beam  to  measure  the  largest 
displacements  with  its  actuator  located  at  the  wall.  Non- 
colocated  systems  also  allow  greater  design  flexibility  if 
precise  stable  control  can  be  exerted  at  a  distance  through 
the  flexible  structure. 

In  design  of  these  control  systems,  whether  they  are 
colocated  or  non-colocated,  an  accurate  mathematical  model  of 
the  structure  is  required.  When  the  structure  is  modeled  as 
a  continuous  systems,  it  is  described  by  partial  differential 
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equations.  But,  for  large  problems  these  may  be  impractical 
to  solve.  Instead,  computer  based  Finite  Element  Method  (FEM) 
is  the  preferred  way  to  model  structures.  These  models  too 
can  become  very  difficult  to  solve  simply  because  of  its  size. 
Each  element  has  nodes  associated  with  it  and  each  node  can 
have  up  to  six  Degrees  of  Freedom  (DOF)  for  translations  and 
rotations  (the  DOF  represents  the  unknowns  in  the  problem) . 
Large  finite  element  models  are  usually  truncated  to  smaller 
number  of  modes.  But,  the  truncation  introduces  more 
uncertainties  and  modeling  errors  to  the  system.  In 
particular,  the  truncated  models  introduce  RHP  zeros  which 
makes  the  system  non-minimum  phase.  Traditionally,  non¬ 
minimum  phase  systems  have  been  avoided  because  they  are 
difficult  to  control.  Therefore,  the  objective  of  the 
controller  is  to  a  make  the  system  robust  in  the  face  of 
uncertainties  and  model  variations. 

This  thesis  examines  the  effects  between  colocated  and 
non-colocated  sensors  and  actuators  on  flexible  structures. 
To  truly  model  the  complexities  of  a  flexible  system,  a 
commercially  available  finite  element  model  of  a  Contraves 
P52F  gimbal  structure  will  be  used.  First,  a  simple  three 
element  lumped  spring-mass  system  is  used  to  illustrate  basic 
principles  of  applying  control  theory  to  a  structure. 
However,  this  single  motion  DOF  model  does  not  exhibit  any  RHP 
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zeros  of  a  non-minimum  phase  system  usually  associated  with 
non-colocation.  A  two  motion  degree  of  freedom  system,  a 
transverse  beam,  is  examined  to  deal  with  RHP  zeros  in  control 
design . 

The  optimal  control  design  techniques  of  linear  quadratic 
Gaussian  and  loop  transfer  recovery  (LQG/LTR)  are  used  to 
control  these  systems.  The  design  techniques  developed  for 
the  beam  are  then  applied  to  the  Contraves  P52F  gimbal.  This 
allows  the  LQG/LTR  design  methodology  to  be  used  on  a 
structure  which  exhibits  more  complex  plant  characteristics 
than  a  transverse  beam.  Then  a  thorough  design  analysis  can 
be  evaluated  for  performance  and  robustness  characteristics 
between  the  two  types  of  systems. 

The  following  sections  of  the  thesis  first  covers  the 
transfer  function  between  the  input  (actuator)  and  the  output 
(sensor)  for  the  flexible  systems  in  Chapter  II.  It  will  be 
shown  that  the  poles  of  the  transfer  function  are  the  system's 
natural  frequencies;  whereas,  the  zeros  are  functions  of  the 
sensor  and  the  actuator  locations.  Chapter  II  also  introduces 
the  single  motion  DOF  three  element  lumped  mass  model. 
Chapter  III  introduces  the  LQG/LTR  theory  used  to  design  the 
controllers  for  the  colocated  and  the  non-colocated  systems. 
The  three  element  model  is  used  to  illustrate  the  concepts  of 
the  LQG/LTR  theory.  Chapter  IV  presents  the  transverse  beam 
having  RHP  zeros  for  the  non-colocated  case.  Modal  equations 
of  motion  (EOM)  for  finite  element  models  is  used  to  derive 
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the  state-space  equations  which  are  needed  for  control  theory. 
Then  the  LQG/LTR  theory  is  used  to  design  controllers  for  the 
finite  element  transverse  beam.  Chapter  V  investigates  the 
gimbal  structure  which  because  of  its  large  number  of  modes  is 
truncated.  The  control  design  is  compared  between  the  two 
systems  and  evaluated  for  performance  and  robustness. 
Finally,  Chapter  VI  summarizes  the  results  and  gives 
recommendations  for  further  study. 
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II.  BACKGROUND 


This  section  will  present  a  thorough  background  on  the 
poles  and  zeros  associated  with  colocated  and  non-colocated 
systems.  Before  analyzing  the  more  complex  Contraves  P52F 
gimbal  structure,  a  simpler  model  will  first  be  examined  to 
illustrate  basic  principles.  A  three  element  model  was  chosen 
to  simulate  the  torsional  effects  of  the  motor  on  the  gimbal. 
This  model  is  analogous  to  studying  the  longitudinal  or  the 
torsional  vibration  of  a  system.  Because  these  systems  have 
only  motion  about  one  axis,  the  term  single  motion  DOF  will  be 
used  in  this  thesis. 

This  elementary  model  can  show  the  effects  of  colocation 
and  non-colocation  of  the  actuator  and  the  sensor.  With 
colocation  it  is  much  simpler  to  stabilize  a  system  because 
the  transfer  function  exhibits  the  desirable  property  of 
pole/zero  alternation  on  the  imaginary  axis.  In  this  case  the 
poles  go  to  the  neutrally  stable  zeros  during  high  gain 
compensated  feedback.  Non-colocated  systems  may  have  the 
poles  and  zeros  alternating  on  the  imaginary  axis,  but  they 
usually  have  right  half  plane  zeros  as  well.  As  discovered  by 
Cannon  and  Rosenthal  [1],  non-colocated  systems  are  sensitive 
to  parameter  variations  and  may  have  "zero  flipping". 

The  three  element  model  for  the  non-colocated  system 
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examined  in  this  chapter  has  no  zeros.  But,  it  can  be  shown 
to  behave  as  a  non-minimum  phase  system.  Therefore,  one  can 
not  necessarily  make  the  assumption  that  the  system  is  minimum 
phase  because  it  has  no  RHP  zeros  when  modeling  structures  as 
a  single  motion  DOF  system  (i.e.  longitudinal  and  torsional 
vibration  models) . 


2 . 1  POLE/ZERO  PATTERNS  FOR  COLOCATED  SYSTEMS 

First,  the  theory  on  pole/zero  alternation  is  presented 
below  as  proved  by  Martin  in  Reference  7.  Shown  below  is  the 
transfer  function  with  finite  number  of  modes  for  a  position 
output  sensor,  y(x,s),  and  a  control  force  input  actuator, 
u(s),  for  a  flexible  structure 


H  (s) 


y(x,s)  =  £  hi9i 

u  (  s )  i  =1  s2  +  2  C  i  Wj  s  +  go* 


(2.1) 


where  u-  =  i ' th  mode  natural  frequency, 

Cj  =  i'th  mode  damping 

s  is  the  frequency  domain  notation  after 
Laplace  transformation 

The  quantities  gi  and  h.  are  functions  of  the  location  of 
the  sensor  and  the  actuator,  respectively,  with  respect  to  the 
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i'th  mode  shape.  The  zeros  which  are  a  function  of  h^  have 
the  following  properties  as  proved  by  Martin. 

Theorem : 

A  rational  function  of  the  form 


Tn(x) 


Nn(x) 

Dn(x) 


ai 

x-b. 


+ 


a2 

x-b2 


+ 


x-bN 


(2.2) 


with  a(  *  o;  b1  >  b2  >  ...  >  bN;  a,,  b,  e  R; 

will  have  alternating  poles  and  zeros  on  the  real  axis  if,  and 
only  if 

sign(aj)  =  sign(ak)  for  all  j,  k. 


Collorarv : 

In  Eqn  2.2,  if 

sign  (a, )  =  sign(a^  +  1) 

then  Tn(x)  has  a  real  zero  between  the  poles  bi  and  b-  +  1 . 

The  significance  of  the  alternating  poles  and  zeros  as 
shown  by  the  theorems  will  be  developed  in  the  following 
sections.  The  transfer  function  for  a  flexible  mechanical 
system  given  in  Eqn  2.1  can  be  related  to  that  of  Eqn  2.2  by 
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Thus  an 


setting  x  =  s2,  £  =  0,  bs  =  -o2,  and  ai  =  h^ . 

undamped  system  with  poles  at 

s2  =  -o2,  1  <  i  <  N 

will  have  zeros  at 

s2  =  -zk2,  1  -<  k  <  N 

with  Wk2  <  Zk2  <  wk+12, 

if  and  only  if 

signfhjgp  =  sign(hkgk)  for  all  j,k. 

Eqn  2.1  for  the  colocated  sensor/actuator  pair  without 
damping  for  position  output  can  be  expressed  as 


H  ( s ) 


y(Q,s) 

u(s) 


N 

£ 

i  =  l 


Cl). 


(2.3) 


where  a;  =  h.gi  is  the  residue  of  the  i ' th  mode  shape.  Using 
the  mode  shape  for  a  longitudinal  vibration  of  a  rod  as  an 
example  (this  is  also  analogous  to  torsional  vibration) 
[9:158,  15:155],  the  actuator  and  the  sensor  mode  shapes  are 
the  following: 
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hj  =  /2cos{  in  (0)  },  actuator  located  at  x  =  0 , 
g j  =  /2cos{  in  (x)  },  sensor  located  at  distance  x 


When  the  s«.  *sor  and  the  actuator  are  colocated  at  ::  =  0, 
the  dot  product  of  hj  and  q.  becomes  72cos  ( 0 )  *,/2cos  ( 0 )  =  2. 
The  residues  a(  will  always  equal  2  and  is  positive ; therefore, 
the  zeros  and  poles  alternate  on  the  imaginary  axis  as  shown 
in  Figure  2.1. 


v  A 

!■;  i 


Figure  2.1  Alternating 
Poles  and  Zeros 


To  stabilize  this  type  of  system,  the  double  poles  at  the 
origin  require  a  lead  compensator  to  shift  them  away  from  the 
origin.  Then  the  remaining  flexible  poles  will  go  to  the 
zeros  with  an  angle  of  departure  greater  than  90'  to  remain  in 
the  left  half  plane  (LHP).  In  section  2.3.1,  an  example  of 
this  will  be  shown. 
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2 . 2  POLE/ZERO  PATTERNS  FOR  NON-COLOCATED  SYSTEMS 


Using  Eqn  2.3  when  the  sensor  (g;)  is  located  at  the 
opposite  end  (x  =  1) ,  the  finite  transfer  function  is 


H(s) 


y  d>  s) 

u(s) 


_1_ 

s2 


g  ( -1) iai 
2  =  1  S2  + 


(2.4) 


hf  =  72cos{  i7r(0)  }  =  J2 

g .  =  /2cos{  i7r(l)  }  =  +72  for  even  number  i 

=  -J2  for  odd  number  i 

Clearly,  the  residues  do  not  have  the  same  sign  for  all  the 
modes  and  thus  do  not  have  alternating  pole/zero  pattern  on 
the  imaginary  axis.  Bryson  and  Wie  show  that  the  transfer 
function  Eqn  2.4  for  infinite  number  of  modes  do  not  have 
zeros  except  at  infinity  [15:159].  In  Reference  15,  they 
derive  the  product  expansion  form  of  Eqn  2.4  from  the 
transcendental  transfer  functions  of  a  wave  equation  for 
single  motion  DOF  systems.  Eqn  2.5  shows  the  zero  locations 
for  the  three  different  cases  of  sensor  location  used  in 
Section  2.3  for  the  three  element  model. 
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H  (s) 


y (x,s) 
u(s) 


00 


=  !n 


s  k  =  l 


1  + 


w,. 


where  zk 


(^  =  k7T 


(2.5) 


For  colocation  when  x  =  0,  the  zeros, 


zk  =  (k  -  1/2)  jt 

alternates  between  the  poles.  For  non-colocation  when 
x  =  1/2,  the  zeros, 

zk  =  (2k  -  1)7T 

are  canceled  by  the  poles.  For  non-colocation  when  x  =  1, 

the  zeros. 


z 


k 


oo 


so  that  s2/00  =  0,  and  has  no  zeros. 
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2 . 3  THREE  ELEMENT  LUMPED  MASS  MODEL 


This  section  will  examine  a  single  motion  DOF  system 
about  a  single  axis  for  a  three  element  lumped  spring-mass 
model  to  illustrate  the  principles  used  in  this  thesis.  This 
model  is  in  essence  a  simple  finite  element  model  of  a 
torsional  rod.  The  diagram  below  shows  the  lumped  spring-mass 
model  and  the  governing  equations  of  motion. 


Ji6i  =  Tra  -  K, (0,  -  0,) 

J202  =  K1(O1-02)  -  K2(02  -  03)  (2.6) 

Jj0j  =  K2(02  -  0j) 
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where 


Jj  are  the  moments  of  inertia, 

0j  are  the  angle  of  rotation, 

Tm  is  the  motor  torque  applied  at  mass  J1 
K .  are  the  spring  constants. 

Taking  the  values  for  the  moments  of  inertia  and  the 
spring  constants  as  unity,  the  equation  simplifies  to  the 
following : 


a,  =  -e.  +  e2  +  Tm 

02  =  0!  -  202  +  03  (2.7) 

03  =  02  -  03 

The  output  of  the  measurements  of  the  torsional  rotation 
are  the  following: 


Yi  =  0i' 

y2  =  e2, 

y3  =  03 ’ 

These  three  second  order  linear  equations  can  be  put  into 
the  following  state  space  form: 

X  =  Ax  +  Bu  (2.8) 

y  =  Cx 
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Defining  the  following  as  the  state  and  control  vectors 


02 


02 

03 


u  =  Tm  =  input 


you  have  the  following  state  space  form  for  the  equations  of 
motion 


0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

1 

-1 

1 

0 

0 

0 

0 

1- 

-2 

1 

0 

0 

0 

0 

1- 

-1 

0 

0 

0 

*r 

'  * 

0 

x2 

0 

x3 

+ 

0 

1 

x5 

0 

0 

X6_ 

y 


1  0  0  0  0  0 
0  1  0  0  0  0 
0  0  1  0  0  0 


X 


(2.9) 


Eqn  2.8,  the  state  space  equation,  can  be  represented  in 
the  frequency  domain  by  the  following  familiar  form  of  a 
transfer  function. 


H(s)  =  C [ si  -  A]  _1B 


(2.10) 


2 


10 


For  the  lumped  spring-mass  system,  the  S ISO  transfer  functions 


are  the  following:1 


H(s) 


S4  +  3  s2  +  1 
s2  +  1 

_ 1 

S2  (s4  +  4s2  +  3) 


(2.11) 


The  numerator  represents  the  zeros  for  the  three  output 
locations.  Note  the  first  polynomial  in  the  numerator  is  for 
the  colocated  case  and  the  second  one  is  the  non-colocated 
case  for  y2  =  02.  The  third  polynomial  which  is  zeroth  order 
represents  the  case  where  the  sensor/actuator  pair  are  located 
on  opposite  ends.  The  denominator  of  the  transfer  function  is 
the  characteristic  equation  of  the  model.  Calving  for  the 
roots  of  the  characteristic  equation  gives  the  system  poles 
(structure's  natural  frequencies).  These  poles  are  the  same 
as  taking  the  eigenvalues  of  the  A  matrix.  The  poles  and  the 
zeros  are  listed  below  in  Table  2.1.  The  table  agrees  with 
Eqn  2.5  which  shows  colocation  has  alternating  zeros  and  non¬ 
colocation  does  not  have  zeros. 


^atlab  was  used,  using  [num,den]  =  ss2tf(A,B,  C,  D,l,w) 
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Table  2.1  Poles  and  Zeros  of  the  Transfer  Function.  Ean  2.11 


poles 


zeros,  zeros.  v:  zeros,  v. 


0,0 

±  l.OOOi  ±  .618i  ±  l.OOOi  none 

±  1 . 7  32 i  ±  1 . 618i 


The  following  are  the  Bode  plots  of  the  magnitude  versus 
frequency  for  the  colocated  (y1  as  output)  and  the  non- 
colocated  (y3  as  output)  transfer  functions.  The  dips 
represent  the  zeros  on  the  imaginary  axis  and  the  rises  are 
the  poles. 


Figure  2.3  For  Colocated,  y,,  and  Non-colocated,  y3 
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2.3.1  COLOCATION 


The  zeros  of  the  transfer  function  depend  on  the  sensor 
and  the  actuator  location.  One  can  see  from  Eqn  2.11  that 
there  are  three  polynomial  equations  each  representing  one  of 
the  output  cases.  For  the  colocated  case  (y1  =  0,) ,  the  second 
order  polynomial,  s4  +  3s2  +  1,  has  zeros  (roots  of  the 
numerator)  as  shown  in  Table  2.1.  The  poles  and  zeros  are 
shown  to  be  alternating.  Using  Eqn  2.2  reveals  the  transfer 
function  after  partial-fraction  expansion  has  all  its  residues 
having  the  same  sign.  The  root  locus  plot  of  Figure  2.4  shows 
the  alternating  pattern  of  poles  and  zeros  when  the  residues 
have  all  the  same  sign  as  Martin's  theorem  shows. 

To  see  the  robust  properties  of  the  colocated  system,  the 
root  locus  for  open  loop  plant  for  the  system  in  Figure  2.4 
will  be  plotted. 


Feedback  and  Proportional  Gain 
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The  following  equation  represents  the  closed  loop  transfer 
function  of  the  plant  under  unity  feedback  with  proportional 
gain. 


Gcl(s)  =  _ kGjsj  (2.12) 

1  +  kG (s) 

where  G(s)  represents  the  transfer  function  of  the  open  loop 
plant. 

k  =  proportional  feedback  of  the  output  with  no 
compensation 

The  root  locus  plot  of  Figure  2.5  contains  the  poles  of 
the  solution  to  the  characteristic  equation  of  Eqn  2.12  as 
gain  k  increases.  The  plot  reveals  one  of  the  rigid  body 
poles  (there  are  two  at  the  origin)  are  destabilized 
immediately  while  the  flexible  poles  are  marginally  stable  on 
the  imaginary  axis. 


2 


14 


ROOT  LOCUS 
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Figure  2.5  Colocation  of  Sensors  and  Actuators 


The  system  is  clearly  unstable  for  proportional  compensation. 
But,  a  simple  lead  compensator  can  stabilize  the  plant  as 
shown  in  Figure  2.6. 
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Figure  2.6  Colocation  with  Lead  Compensation 


The  compensator  used  is  the  following: 


G 


CL 


s  +  24 


(2.11) 


As  depicted  in  Figure  2.6,  the  colocated  system  remains  stable 
even  under  high  gain  feedback.  The  gain  value  was  increased 
from  .5  to  20. 
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2.3.2  NON-COLOCATION 


For  the  case  where  the  sensor  is  located  in  the  middle 
(y2  =  02) ,  there  is  an  excess  pole  which  causes  the  root  locus 
plot  to  go  unstable  during  proportional  feedback  as  shown  in 
Figure  2.7. 


ROOT  LOCUS 


Figure  2.7  Non-colocation  Under  Proportional 
Feedback  with  the  Sensor  Located  at  Mass  J, 


Partial-fraction  expansion  reveals  this  non-colocated 
system  does  not  all  have  the  same  sign  for  its  residues,  so, 
the  system  does  not  have  alternating  poles  and  zeros.  This  is 
clear  by  examining  the  poles  and  zeros  in  Table  2.1.  In  fact, 
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this  system  has  the  undesirable  property  of  being  unobservable 
because  the  zeros  cancel  one  of  the  poles.  For  the  third  case 
where  the  sensor  and  the  actuator  are  located  on  opposite  ends 
of  the  structure,  there  are  no  zeros.  Therefore  the  system  is 
clearly  unstable  during  proportional  feedback  as  shown  in 
Figure  2.7. 


i OCUS 


Figure  2.8  Non-colocated  Case  Under  i soportional 
Feedback  with  Sensor  at  the  Opposite  End  at  Mass  J3 


Using  a  simple  lead  compensator  as  in  the  colocated  case, 
the  first  flexible  pole  is  immediately  destabilized  as  shown 
in  the  root  locus  plot  in  Figure  ;.8.  The  transfer  function 
for  the  lead  compensator  used  is 
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In  the  no/i-colocated  case,  a  lead  compensator  is  ineffective. 
To  achieve  stability,  a  higher  order  compensator  is  clearly 
needed.  For  this  thesis,  the  Linear  Quadratic  Gaussian  (LQG) 
design  techniques  will  be  used  to  design  the  controller. 
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III.  LINEAR  QUADRATIC  GAUSSIAN  /  LOOP  TRANSFER  RECOVERY 


3 . 1  LOG/LTR  THEORY 

Linear  Quadratic  Gaussian/Loop  Transfer  Recovery 
(LQG/LTR)  theory  is  used  to  design  the  controllers  to  increase 
the  performance  and  robustness  of  the  control  systems 
presented  in  this  thesis.  The  first  step  to  the  LQG/LTR 
method  is  to  design  the  Linear  Quadratic  Gaussian  (LQG) 
control] er.  A  quadratic  performance  index  is  used  to  define 
the  LQG  controller;  therefore,  it  produces  an  optimal  control 
design  stabilizes  the  closed  loop  system  for  the  given  design 
conditions.  The  LQG  controller  is  comprised  of  the  Linear 
Quadratic  Regulator  (LQR)  and  the  Linear  Quadratic  Estimator 
(LQE) .  The  LQR  is  a  full-state  feedback  controller  and  the 
LQE  is  an  estimator,  commonly  called  the  Kalman  filter. 

The  LQG/LTR  design  method  modifies  the  standard  LQE  and 
recovers  the  guaranteed  robustness  of  the  full-state 
regulator.  This  results  in  a  closed  loop  system  (the  combined 
plant  and  the  compensator)  that  is  robust  to  uncertainties, 
disturbances  and  gain  increases.  The  LQG/LTR  methodology  is 
also  ideal  for  multi-input-multi-output  (MIMO)  systems.  The 
following  section  will  first  introduce  the  basics  of  the  full- 
state  feedback  control  theory.  Then,  the  estimator  and  the 
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LQG  controller  will  be  presented.  Finally,  loop  transfer 
recovery  is  developed.  These  sections  briefly  introduce  the 
optimal  control  theory  which  is  presented  in  more  detail  in 
many  other  references.  In  particular  the  technical  report, 
Introduction  to  Robust  Multivariable  Control .  by  Ridqely  and 
Banda  is  extensively  used  by  the  author  to  develop  the  next 
four  sections  [10]. 


3 . 2  LINEAR  QUADRATIC  REGULATOR 

The  linear  quadratic  regulator  as  taken  from  chapter  6  of 
Ridgely  and  Banda  is  the  following.  The  LQR  relies  on 
minimizing  the  quadratic  performance  index 

J  =  J  [xT(  t)  Qcx{  t)  +  uT(  t)  Rc  u  ( t)  ]  dt  (3.1) 

for  the  state-space  Eqn  2.9. 

The  weighting  matrices  Qc  and  Rc  are  chosen  by  the 
designer  depending  on  the  importance  of  the  state  or  the 
control  vectors.  If  the  [A,  B]  pair  is  stabilizable ,  then  the 
optimal  control  law  is 

u  =  -Kcx  (3.2) 
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The  gain  matrix,  Kc,  is  given  by 

Kc  -  Kc'1BtP  (3.3) 

where  P  is  the  symmetric  positive  semi-definite  matrix 
solution  to  the  algebraic  Riccati  equation 

0  =  AtP  +  PA  -PBR'^P  +  Qc  (3.4) 

where  selecting  Qc  =  QcT  >  0  (postive  semi-definite)  is  a 

sufficient  condition  for  asymptotic  stability  of  the  closed- 
loop  system.  Rc  must  be  postive  definite.  Substituting  the 
control  law,  Eqn  3.2,  into  Eqn  2.9  yields  the  closed  loop 
system. 

x  =  Ax  +  B[-Kcx] 

=  [A  -  BKJx  (3.5) 

Figure  3.1  depicts  the  state  space  system  of  Eqn  3.5. 
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Figure  3.1  Block  Diagram  of  the  Full- 
state  Controller 


3 . 3  LINEAR  QUADRATIC  ESTIMATOR 

The  one  drawback  of  using  the  full-state  regulator  is  it 
assumes  all  the  states  can  be  measured.  It  is  frequently 
impossible  or  very  expensive  to  measure  all  the  states  (many 
sensors  may  be  required  on  a  space  structure) ; therefore,  an 
estimator  must  be  used  to  model  the  system.  This  estimator 
must  also  take  into  account  disturbances  in  the  system.  The 
familiar  state-space  equation  now  including  disturbances  is 

X  =  Ax  +  Bu  +  Tw  (3.6) 

y  =  Cx  +  v  (3.7) 

where  w  and  v  are  input  and  output  disturbances,  respectively. 
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The  disturbances  are  assumed  zero-mean  Gaussian  stochastic 


processes  which  are  uncorrelated  in  time  and  have  the 
covariances 

E[  w  ( t )  wT  (  t  )  ]  =  Qo£(t-r)  >  0, 

E[  v  (t)  vT  ( r )  ]  =  Rf5(t-r)  >  0 

The  covariance  matrix  Q0  is  positive  semi-definite ;whereas ,  Rf 
is  positive  definite.  The  correlation  between  w  and  v  will  be 
assumed  to  be  zero 

E [  w(t)vT(t)  ]  =  0 

Equation  3.6  and  the  Kalman  filter  are  represented  by  the 
block  diagram  below. 


Figure  3.2  Block  Diagram  of  the  Kalman 
Filter 
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The  equation  for  the  estimator  is  given  by 

xe  =  Axe  +  Bu  +  Kf(y  -  Cxe)  (3.8) 

where  x„  is  the  estimate  of  the  states. 

The  following  development  of  the  Kalman  filter  is  taken 
directly  from  Ridgely  and  Banda.  First,  an  assumption  must  be 
made:  the  input  and  output  disturbances,  w  and  v,  are  time- 
invariant  and  wide-sense  stationary.  Then  the  matrices  Qo  and 
Rf  are  constant.  This  is  a  valid  assumption  as  long  as  the 
observation  of  the  output  is  much  greater  than  the  dominant 
time  constants  of  the  system.  The  Kalman  filter  gain  matrix, 
Kf,  minimizing  the  mean-square  error 

E[eTe] 

where 

e  =  x  -  x„ 
e 

is 

Kf  =  ECTRf'1  (3.11) 

Z,  the  variance  of  the  error  function,  is  found  by  solving  the 
algebraic  variance  Riccati  equation 

0  =  AZ  +  ZAT  -  ZCTRf"1CZ  +  Qf  (3.12) 


(3.9) 

(3.10) 
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with  Qf  =  rQorT .  Frequently,  r  =  I  (meaning  each  state  has  its 
own  distinct  process  noise) . 

The  algebraic  variance  Riccati  equation  shown  in  Eqn  3.12 
has  several  solutions,  for  which  the  correct  solution  is 
unique  and  positive  definite.  A  sufficient  condition  for  £  to 
exist  is  that  the  pair  [A,  C]  be  completely  observable.  This 
condition  may  be  relaxed  to  detectability,  in  which  case  it  is 
necessary  and  sufficient  and  £  may  be  positive  semidef inite . 
Given  that  £  exists,  the  error  dynamics  of  the  filter  are 

e  =  x  -  xe  (3.13) 

=  [Ax  +  Bu  +  Fw]  -  [Axe  +  Bu  +Kf{y  -  Cxg}] 

=  [A  -  KfC]e  +  [T  -Kf][w  v ] T 

Therefore,  the  poles  of  [A  -  KfC]  are  the  poles  of  the 
estimator  error  response.  The  poles  must  be  asymptotically 
stable (  the  error  must  be  getting  smaller)  if  and  only  if  the 
pair  [A,  T]  is  stabilizable . 


3 . 4  LINEAR  QUADRATIC  GAUSSIAN 

Combining  the  results  of  LQR  and  LQE  gives  the  following 
expression  for  the  LQG  compensator 


3 


7 


Xe(t)  =  Ax (t )  -  BKcxe(t)  +  Kf[y(t)  -  Cxe(t)] 
=  (A  -  BKC  +  KfC)xe(t)  +  Kfy(t) 


(3.14) 


Taking  the  Laplace  transform  yields  the  following 

xe(s)  =  [si  -  A  +  BKC  +  KfC]'1Kfy(s)  (3.15) 

Now,  substituting  this  into  the  control  law  (dropping  the 
s  notation) 

U  =  -KcXe  (3.16) 

yields  the  expression  for  the  LQG  compensator 

u  =  -KJsI  -  A  +  BKC  +  KfC]_1Kfy  (3.17) 

substituting  the  plant  transfer  function  without  the  noises, 
w  and  v, 

y  =  C (si  -  A)  '1Bu  (3.18) 

gives 

u  =  -Kc[sl  -  A  +  BKC  +  KfC]'1KfC(sI  -  A)_1Bu  (3.19) 

The  following  figure  represents  the  Eqn  3.19  for  the  LQG 
compensator  and  the  plant. 
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Figure  3.3.  Block  diagram  of  the  LQG  system. 


The  poles  of  the  LQG  compensator  are  seen  to  be  solutions  of 

det  [  si  -  A  +  BKC  +  KfC]  =  0 

Although  the  poles  of  the  regulator,  the  estimator  and  the 
closed  loop  system  are  all  stable,  the  LQG  compensator  poles 
are  not  always  stable.  The  eigenvalues  of  the  closed-loop 
system  are  evaluated  to  prove  the  stability.  Taking  the  two 
equations  we  have  for  the  state 

x  =  Ax  +  B[-Kcxe]  +  Tw  (3.2  0a) 

Xe  =  (A  -  BKC  +  KfC)xe  +  KfCx  +  Kfv  (3.20b) 
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Remembering  that 


e  =  x  - 


(3.13) 


We  can  put  Eqn  3.20a  and  Eqn  3.20b  into  its  state  space  form 


X 

A  -  BKC  BKC 

[x1 

r  o 

w 

6 

0  A  -  BKfC 

e 

+ 

r  "Kf 

v_ 

Using  Schur's  formula,  the  above  equation  can  be  broken  into 
its  determinant  form 

det  [si  -  A  +  BKc]«det[Sl  -  A  +  KfC]  =  0  (3.22) 

Eqn  3.22  shows  that  the  LQG  compensator  is  composed  of  the 
regulator  and  the  estimator  poles  which  are  stable. 
Therefore,  the  closed  loop  LQG  systems  are  always  stable, 
although  the  compensator  itself  may  not  be  stable.  An  example 
of  this  unstable  compensator  will  be  shown  in  the  next 
section. 


3 . 5  LOG  DESIGN  ON  THREE  ELEMENT  MODEL 

The  Linear  Quadratic  Gaussian  (LQG)  design  technique 
developed  in  section  3.4  will  be  used  to  develop  a  sixth  order 
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compensator  (same  order  as  the  plant)  for  both  the  colocated 
and  non-colocated  cases.  To  make  a  fair  design  comparison, 
the  closed  loop  bandwidths  for  the  two  systems  were  made 
equal.  This  bandwidth  was  pushed  as  close  as  possible  to  the 
lowest  frequency  zero.  This  ensures  the  flexible  poles  will 
have  an  effect  the  plant  and  the  controller. 

Briefly,  the  LQ  Regulator  is  designed  for  the  highest 
bandwidth  it  can  achieve  by  varying  the  state  space  weighting 
matrix,  Qc-  The  bandwidth  achievable  is  limited  by  the  first 
imaginary  zero  which  causes  the  closed  loop  gain  to  go  below 
the  -3  dB  line  quickly.  Then,  the  LQ  Estimator  is  calculated 
by  estimating  the  noise  matrices,  Qo  and  Rf.  This  thesis  uses 
an  approximate  noise  intensity  for  Qo  as  ten  percent  of  the 
input  force.  The  regulator  and  the  estimator  are  then 
combined  to  construct  the  LQG  controller.  In  each  case,  the 
design  is  iterated  by  varying  the  Qc  weighting  matrix  for  the 
LQR  until  they  have  approximately  the  same  bandwidth.  See 
Figure  3.4. 
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Figure  3.4  Closed  Loop  Bandwidths  for  the  Three 
Element  Model 


The  procedure  leading  to  the  LQG  design  was  facilitated 
by  using  a  MATLAB  script  file,  LQGD.M  (See  Appendix  C  for  the 
program)  .  The  weighting  matrices  used  for  the  LQR  for  the 
colocated  case  is 

Qc  =  diag  ( 10  10  105  105  105  105)  , 

and  for  the  non-colocated  case  is 

Qc  =  diag  (10  10  10  10  102'5  102'5)  . 

For  both  cases,  the  noise  intensity  at  the  input  for  the  LQE 
is  chosen  as 

Q0  =  102. 
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After  designing  the  LQG  controller  the  ■'-oot  locus  of  the 
closeu-loop  system  is  plotted  to  check  the  stability 
robustness.  The  transfer  function  of  the  LQG  controller  for 
the  colocated  case  is 


(s  +  .177)  (s  +  .  19± . 89  2 i )  (s  +  .37±1.637i) 

(s  +  316.2)  (s  +  3.12  5)  (s  V".l55±  .  8  3  8  i  )  (s  +  .  35±1.62i) 


Figure  3.5  shows  the  root  locus  plot  of  the  closed  loop 
colocated  system.  The  compensated  plant  remains  stable  for 
all  gains  in  the  range  0.5  to  30.0. 


Figure  3.5  Root  Locus  for  the  LQG  Design  without 
LTR  for  the  Colocated  System 
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The  transfer  function  of  the  LQG  controller  for  the  non- 
colocated  case  is 


(s  +  .12)  (s  +  1.72)  (s  -  7.5)  (s  +  .208±1.07i) 

(s  +  1.304)  (s  +  3.1)  (S  +  1. 33±1. 56i)  (s  +  .95212.  li) 


Figure  3.6  shows  the  root  locus  of  the  non-colocated 
closed  loop  system.  With  increasing  gain,  the  closed  loop 
poles  of  the  compensator  and  the  plant  move  into  the  right 
half  plane  after  a  gain  of  k=1.75.  This  is  a  seventy-five 
percent  gain  increase  from  the  nominal  design,  but  it  is  not 
as  robust  as  the  colocated  system  which  remains  stable  for 
gains  up  to  k  =  30.  One  can  see  that  LQG  does  not  guarantee 
stability  in  the  face  of  uncertainties.  In  fact,  for  the  non- 
colocated  system,  it  goes  unstable  rather  easily.  In  other 
words,  the  controller  is  not  robust  and  LTR  techniques  are 
needed . 
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3 . 6  LOOP  TRANSFER  RECOVERY 


As  mentioned  in  section  3.5,  the  disadvantage  of  the  LQG 
compensator  is  that  it  is  generally  not  robust.  The  three 
element  non-colocated  example  went  unstable  after  a  small  gain 
increase.  One  reason  is  that  the  estimator  inserted  into  the 
LQG  loop  no  longer  guarantees  the  stability  margins  from  the 
full-state  feedback  regulator.  Loop  recovery  technique  must 
be  used  by  adjusting  the  Kalman  filter  gains. 

In  looking  at  Figure  3.3  of  the  LQG  block  diagram,  the 
return  ratio  (the  characteristic  equation  of  the  SISO  transfer 
function)  at  point  marked  1  determines  the  robustness  and 
performance  properties  for  the  plant,  G(s).  The  return  ratio 
at  point  1  is 

K  (s)  G  (s)  =  -Kc[sl  -  A  +  BKC  +  KfC]'1KfC(sI  -  A)  _1B  (3.23) 

If  you  break  the  loop  at  point  1,  the  return  ratio  at  point  2 
is  the  full  state  feedback  controller 

Klqr(s)  =  Kc(sl  -  A)  _1B  (3.24) 

The  reason  is  when  you  break  the  loop  at  point  1,  the  signal 
to  the  Kalman  filter  matrix  Kf  is  zero.  This  assumes  that  the 
A,  B,  and  C  matrices  of  the  filter  match  those  of  the  plant 
exactly.  Thus,  the  gist  of  the  LTR  theory  is  to  make  the 
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return  ratios  at  points  1  and  2  to  be  the  same.  The  following 
is  taken  from  Maciejowski  [6:232]. 

Let  $  =  (si  -  A)  and  rewrite  Eqn  3.23  without  the 

frequency  domain  notation  (s)  for  brevity. 

K  ( s)  G  (s)  =  -Kc[$  +  BKC  +  KfC]'1KfC$>'1B  (3.25) 

Without  going  into  the  formal  proof  which  is  shown  in 
Ridgely  and  Banda  [10:ch.  8]  and  Maciejowski  [6:232-234],  one 
can  see  how  Eqn  3.25  becomes  3.24  by  observing  what  happens  as 
Kf  is  increased  toward  infinity.  At  low  frequenies  (s  =  ju) , 
the  term  inside  the  bracket,  $  +  BKc,  becomes  much  smaller 
than  KfC .  Thus,  the  bracketed  term  approaches  [KfC]'1.  This 
leads  to 

K(s)G(s)  =  -Kc  [  KfC]"1  KfC  *_1B  (3.26) 

K(s)G(s)  =  -Kc  I  #'1B 
K  ( s)  G  (s)  =  -KC$'1B 

Intuitively,  Eqn  3.26  shows  that  at  low  frequencies  and 
high  estimator  gains  the  LQG  controller  and  the  plant 
approaches  the  behavior  of  a  full  state  regulator.  In  terms 
of  poles  and  zeros,  the  effect  of  increasing  the  gain  Kf 
causes  the  closed  loop  poles  of  the  Kalman  filter  to  notch  out 
the  plant  zeros.  The  plant  poles  then  move  toward  the 
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compensator  zeros.  In  turn,  these  compensator  zeros  approach 
the  closed  loop  pole  locations  of  the  full-state  regulator  and 
thus  achieves  the  robustness  guaranteed  by  the  LQR.  One  can 
then  increase  the  robustness  over  large  a  bandwidth  by 
increasing  the  gain  Kf.  See  the  LTR  plots  of  Figure  3.7  and 
Figure  3.9  in  Section  3.7  for  examples. 

However,  there  is  a  design  trade  off  because  increasing 
the  filter  gains  also  increases  the  system  noise  response. 
One  thing  to  keep  in  mind  is  that  increasing  the  gain  no 
longer  makes  it  a  true  Kalman  filter.  The  noise  intensity  is 
changing  from  the  initial  assumed  Qf  =  Q0.  See  the  equation 
below  when  the  loop  transfer  recovery  is  applied  at  the  plant 
input . 


Qf  =  Q0  +  q2BVBT 

Rf  =  Ro 

V  is  any  postive  definite  symmetric  matrix  and  is  usually 
taken  as  identity.  Qo  and  Ro  are  the  actual  noise  intensities. 
The  second  term  with  q2  is  the  additional  fictitious  output 
noise  associated  with  LTR.  When  q  =  0,  it  becomes  the 

standard  Kalman  filter. 
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3.6.1  ROOT  MEAN  SQUARE  RESPONSE 

The  effect  of  the  increasing  the  fictitious  noise  on  the 
system  can  be  measured  by  the  Root  Mean  Square  (RMS)  response 
for  the  LQG/LTR  closed  loop  system.  The  covariance  of  the 
output  must  be  found  by  first  solving  the  Lyapunov  equation 
for  the  state  variance  [5:104]. 

AQX  +  QxAt  +  BVBt  =  0  (3.27) 

where 

Qx  =  E  (xxT) 

V  =  I 

A  and  B  are  from  state  space  equation 

The  output  covariance  is  then 
Qy  =  E(yyT) 

which  after  combining  with  Eqn  3.27  becomes 

Qy  =  CQxCt  (3.28) 

The  RMS  response  is  found  by  simply  taking  the  square  root  of 
the  diagonal  of  the  covariance  in  Eqn  3.28. 
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3.6.2  LTR  WITH  NON-MINIMUM  PHASE  SYSTEMS 


LTR  theory  is  not  guaranteed  to  work  with  non -minimum 
phase  systems.  Maciejowski  states  that  some  of  the  Kalman 
filter's  eigenvalues  or  poles  from  the  LQG  design  moves  toward 
the  plant's  zeros  [6:231].  This  implies  LTR  can  only  be  used 
for  minimum  phase  plants  since  the  eigenvalues  of  the  closed- 
loop  regulator  and  the  estimator  cannot  be  in  the  left  half 
plane.  However,  LTR  may  still  work  if  the  right  half  plane 
zeros  are  above  the  cross-over  frequency. 


3.7  LOOP  TRANSFER  RECOVERY  ON  THE  THREE  ELEMENT  MODEL 

For  the  three  element  model,  the  colocated  system  shows 
excellent  loop  recovery  properties  throughout  its  frequency 
range  (10'2  to  102  rad/sec)  .  Examination  of  the  system 
eigenvalues  shows  that  the  poles  of  the  plant  and  the 
compensator  moving  toward  the  poles  of  the  full-state 
controller.  Figure  3.7  shows  clearly  the  open  loop  system 
approaching  the  target  loop  of  the  full-state.  The  high 
fictitious  noise  of  1015  was  able  to  get  full  recovery  (as 
evident  by  the  loop  matching  the  full  state) .  The  root  locus 
of  the  closed  loop  K(s)G(s)  system  shows  it  retains  excellent 
robustness  with  the  poles  going  unstable  after  a  gain  increase 
of  k  =  28.5  at  q2  =  1015.  This  is  almost  a  three-thousand 
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percent  gain  variation  that  the  colocated  system  can  handle! 
See  Figure  3.8  for  the  root  locus  plot. 

The  non-colocated  system  does  improve  its  robustness 
slightly  with  LTR,  although  loop  recovery  is  not  as  easy  to 
achieve  with  the  non-colocated  system  (indication  that  this 
type  of  system  is  non  minimum  phase).  See  Figure  3.9  for 
q2  =  [  0  1018  102°  ]  .  Notice  the  good  recovery  at  low 

frequencies,  but  not  at  high  frequencies.  In  fact  there  are 
small  spikes  in  the  loops  where  it  diverges  from  the  full 
state's  open  loop.  Using  a  large  fictitious  noise  value  of 
1020  did  get  good  recovery  and  damped  out  the  spike.  It  also 
improved  the  robustness  of  the  system  to  gain  variations  up  to 
k  =  4.  See  Table  3.1 


Table  3.1  LTR  for  Colocated  and  Non-colocated  Three  Element 
_ Model _  _ 


q2 

colocated 

non-colocated 

0 

30 

1.75 

10* 

10s 

30 

1.75 

17.0 

1.25 

109 

6.5 

1.50 

1012 

8 . 0 

1.50 

1015 

28.5 

2.0 

1018 

30 

2.75 

102° 

30 

4 . 0 

1024 

30 

7.0 

The  table  shows  a  decrease  in  the  colocated  system  when 
q2  =  109  and  1012.  Starting  at  these  fictitious  noise  values, 
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the  colocated  RMS  response  becomes  greater.  Then  the  RMS 
response  stabilizes  after  q2  =  1015.  See  Table  A.l  in  Appendix 
A.  Thus,  the  increase  in  the  noise  of  the  colocated  system 
appears  to  have  an  effect  on  the  robustness  of  the  system  to 
loop  transfer  recovery. 

In  looking  at  the  LTR  plots  and  the  Bode  plots,  the  non- 
colocated  system  has  the  advantage  of  having  the  high 
frequency  roll-off.  This  is  desirable  to  prevent  the  noise 
from  amplifying  and  driving  the  system  unstable.  The  non- 
colocated  system  does  have  a  major  drawback  in  that  it  behaves 
like  a  non-minimum  phase  system  with  RHP  zeros.  Figure  3.10 
shows  the  root  locus  plot  using  the  fictitious  noise  value  of 
1018.  Note  the  poles  moving  into  the  right  half  plane  as  if 
there  were  RHP  transmission  zeros. 
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Figure  3.7  LTR  for  the  Colocated  System 


Figure  3.8  Root  Locus  for  the  LQG  Design  with  LTR 
for  the  Colocated  System 
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Figure  3.9  LTR  for  the  Non-colocated  System 


Figure  3.10  Root  locus  for  the  LQG  desing  without 
LTR  for  the  non-colocated  system 
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3.8  STEP  RESPONSE 


The  unit  step  input  will  now  be  applied  to  the  closed 
loop  full  state  regulator.  The  unit  step  input  response  is 
useful  for  analyzing  the  performance  characteristics  of  a 
system.  The  time  response  is  useful  in  revealing  the  rise 
time,  settling  time,  and  the  steady  state  value  [9:40]. 

The  RHP  zero  has  an  interesting  influence  on  the  step 
response.  Reid  states  that  for  non-minimum  phase  systems  the 
initial  response  is  negative.  This  means  the  system  moves  in 
the  opposite  direction  in  relation  to  the  final  steady-state 
value.  If  the  system  has  no  zeros  (i.e.  the  non-colocated 
three  element  mass  model) ,  the  initial  response  will  be  flat. 
The  plot  of  the  step  response  for  the  colocated  and  non- 
colocated  systems  are  shown  in  Figure  3.11.  The  non-colocated 
system  shows  a  flat  response  initially  since  it  has  no  zeros. 
The  colocated  step  response  shows  it  fluctuates  as  it  comes  to 
its  steady-state  value.  This  is  the  result  of  the  imaginary 
zeros  and  because  the  poles  are  lightly  damped. 
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Figure  3.11.  Step  Response  of  the  Three  Element 
Model 


3 . 9  CONCLUSION 


The  colocated  LQG/LTR  system  is  very  robust  to  gain 
variations.  However,  the  robustness  decreases  for  q 2  =  109 
through  1012.  The  RMS  response  at  these  fictitious  noise 
values  show  that  the  colocated  system  is  much  higher  than  the 
non-colocated  system.  While  the  non-colocated  case  has  low 
RMS  response,  it  is  not  robust  in  comparison  to  the  colocated 
system.  It  does  improve  slightly  for  very  large  q2  values. 
See  Table  A.l  in  Appendix  A.  Looking  at  the  closed  loop 
bandwidths  show  that  the  non-colocated  system  has  very  good 
damping  and  has  the  desirable  high  frequency  roll  off.  The 
colocated  system  has  little  damping  of  its  flexible  poles.  In 
this  regard  the  non-colocated  case  is  better. 
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The  step  response  to  the  unit  input  also  shows  the  non- 
colocated  system  has  better  damped  poles  and  a  smoother  rise 
time  curve.  However,  the  system  exhibits  non-minimum  phase 
behavior  of  having  no  initial  response  to  the  input  for  the 
first  two  seconds.  See  Figure  3.11.  This  ma^  be  an 
unacceptable  response.  Recall  this  single  motion  DOF  model 
did  not  have  RHP  zeros  to  cause  a  negative  response  typical  of 
non-minimum  phase  systems.  This  leads  to  the  next  chapter 
which  shows  that  non-colocated  systems  have  RHP  zeros  for  two- 
motion  DOF  models. 

Observing  the  closed  loop  eigenvalues  of  the  LQG/LTR 
controller  showed  how  it  becomes  robust.  LQG  design  is  helped 
by  LTR  because  as  the  fictitious  noise  is  increased,  the 
compensator  poles  move  toward  the  open  loop  plant  zeros  to 
notch  them  out.  The  Kalman  filter  accomplishes  this  task 
since  its  closed  loop  poles  (A  -  KfC)  at  high  q2  values  moves 
right  onto  the  plant  zeros.  On  the  other  hand,  the 
compensator  zeros  move  toward  the  stable  poles  of  the  closed 
loop  regulator  (A-EKc)  .  Thus,  the  plant  poles  during 
compensated  feedback  must  move  toward  the  compensator  zeros 
which  guarantees  the  stability  and  the  robustness  of  the 
closed  loop  full-state  regulator.  In  essence,  the  LQG 
compensator  inverts  the  nominal  plant  and  substitutes  the 
desired  LQR  dynamics. 

To  summarize  for  the  three  element  model  using  an  initial 
noise  intensity  of  Qo  =  102,  the  colocated  system  can  be  made 
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robust  by  just  using  the  LQG  compensator;  whereas,  the  non- 
colocatea  system  can  be  improved  slightly  with  LTR.  To  get 
better  rise  time  curve  and  damping  for  the  colocated  system 
requires  a  lower  bandwidth  away  from  its  low  frequency 
imaginary  zeros  and  therefore  a  drop  in  performance.  On  the 
other  hand,  the  non-colocated  system  can  achieve  a  higher 
bandwidth  and  better  damping  since  it  has  no  imaginary  zeros 
affecting  the  crossover  frequency  it  can  attain. 
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IV.  A  TWO  MOTION  DEGREE  OF  FREEDOM  SYSTEM 


4 . 1  Introduction 


The  first  example  presented  in  this  thesis  of  the  three 
element  lumped  mass  system  showed  the  non-colocated  system  was 
technically  minimum  phase  (i.e.  no  zeros  in  the  right  half 
plane) .  However,  the  system  showed  non-minimum  phase 
characteristics.  For  instance,  the  step  response  had  initial 
flat  response  characteristic  of  a  non-minimum  phase  system 
with  no  zeros.  Loop  transfer  recovery  to  the  full-state  loop 
shape  was  limited,  especially  in  comparison  to  the  colocated 
loop  recovery  shapes.  At  high  frequencies,  it  exhibited  the 
characteristic  steep  roll-off  of  a  non-minimum  phase  system. 


4 . 2  EXACT  SOLUTION  OF  A  TRANSVERSE  BEAM 


The  three  element  lumped  mass  model  is  a  single  motion 
DOF  system  since  it  only  has  plane  rotation  about  one  axis. 
The  numerator  of  the  non-colocated  transfer  function  was 
zeroth  order  and  had  no  roots  (refer  to  section  2.3.2)  .  Thus, 
a  single  motion  DOF  system  will  not  yield  any  zeros  in  the 
RHP.  Therefore,  a  two  motion  DOF  system  will  be  examined  to 
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demonstrate  the  non-minimum  phase  behavior  for  non-colocated 
structures.  A  two-dimensional  beam  which  can  translate  and 
rotate  will  be  needed.  As  shown  in  Reference  14  by  Bryson  and 
Wie,  a  Bernoulli-Euler  beam  with  transverse  bending  vibrations 
will  have  zeros  in  the  RHP  [14:165]. 


The  equation  of  motion  for  the  transverse  beam  is 


yiiv)  {x,  t)  +  y (x,  t)  =  0 


(4.1) 


where  y 


av 

dx 4 


(iv)  4  y_y_  and  y  & 


d2y 

at2 


and  y(x,t)  is  the  transverse  displacement. 

The  displacement  variables  x  and  y  are  in  units  of  L, 
time  in  units  of  (aL4/EI)1/2.  a  is  the  mass  density  per  unit 
length.  Taking  the  Laplace  transforms  of  Eqn  4.1  yields 
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y(,v)  (x,  s)  +  s2  y  (x,  s) 


0 


(4.2) 


Thus  the  transcendental  transfer  functions  for  free-free 
boundary  conditions  for  the  two  cases  of  colocation  and  non¬ 
colocation  yields  the  following 


y.(-Q.x.s) 

u(s) 


sinhAcosA  -  coshAsinA 
A3  (  1  -  cosAcoshA ) 


(4.3a) 


y  Lb-sl 

u(s) 


sinhA  - 

"X^TT 


sinA _ 

cosAcoshA  ) 


(4.3b) 


where  A4 


s2  or  s  =  jo  (in  the  frequency  domain) 


Solving  for  Eqn  4.3a  directly  shows  the  poles  and  zeros 
alternating  on  the  imaginary  axis  of  the  complex  plane  as 
shown  in  figure  4.2.  The  non-colocated  case,  Eqn  4.3b,  has 
infinite  number  of  reflexive  zeros  on  the  real  axis  as  shown 
in  Figure  4.3. 
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Figure  4.2  Exact  Poles/Zeros  of  a 
Colocated  System 
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Figure  4.3  Exact  Poles/Zeros  of  a 
Non-colocated  System 
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4.2.1  MODAL  TRUNCATION  AND  ITS  EFFECT  ON  ZERO  LOCATION 


Eqn  4.3  for  the  closed  form  solution  to  the  Bernoulli- 
Euler  beam  shows  that  non-colocated  structures  have  RHP  zeros 
on  the  real  axis.  When  the  model  is  truncated,  the  finite 
dimensional  form  of  the  transfer  function  derived  from  Eqn  2.1 
shows  that  there  can  be  complex  zeros  as  well. 


yjLs)  =  __2_  +  £ 

U(S)  s2  i=l  S2  +  u2 


(4.2) 


Reference  14  shows  that  Eqn  4.4  yields  zeros  on  the  real  axis 
of  the  RHP  when  N  =  1.  When  N  =  2,  Eqn  4.4  yields  complex 
zeros  in  the  RHP.  Thus,  a  truncated  model  will  not 
necessarily  have  all  its  zeros  on  the  real  axis.  But,  it  will 
have  RHP  zeros. 


4 . 3  APPROXIMATE  SOLUTION  BY  FINITE  ELEMENT  METHOD 


Using  partial  differential  equation  representation  for 
structures  can  be  difficult  to  solve;  therefore,  the  Finite 
Element  Method  ( FLM) ,  will  be  used  to  analyze  a  two  motion  DOF 
beam.  The  author  used  the  FEM  computer  program,  ANSYS,  to 
solve  for  the  eigenvectors  and  the  eigenvalues  needed  to  get 
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the  equations  of  motion  (EOM) . 

Using  the  finite  element  approach  as  presented  by 
Meirovitch  [8:ch.4],  the  general  EOM  for  an  undamped  system  is 

[m]{q(t)>  +  [k]{q(t)}  =  { Q ( t ) }  (4.5) 

where  [M]  and  [K]  are  constant  mass  and  stiffness 

matrices  of  size  n  (number  of  modes  used) 

{q}  and  (Q(t)}  are  the  column  matrices  of 
generalized  coordinates  and  generalized  forces, 
respectively. 

Eqn  4.4  is  difficult  to  solve  because  of  the  coupling  in 
the  mass  and  the  stiffness  matrices.  To  solve  these  linear 
2nd  order  equations,  the  linear  transformation 

{ q (t )  }  =  [u]  {77  (t)  }  (4.6) 

where  { 77  ( t)  }  is  a  new  set  of  generalized  coordinates, 

[u]  is  a  transformation  matrix  or  a  modal  matrix 
comprised  of  the  eigenvectors, 

is  used  to  decouple  the  mass  and  stiffness  matrices  so  that 
they  are  diagonalized.  The  EOM  using  the  new  generalized 
coordinates  is 

[  m  ]  [  u  ]  {  r?  ( t )  }  +  [  k]  [  u]  {  77  ( t)  )  =  {  Q  (t )  }  (4.7) 
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Pre-multiplying  by  [u]T  results  in  the  modal  EOM 

[M]  { f/  ( t )  }  +  [K]  { r?  (t)  >  =  { N  ( t )  }  (4.8) 

where  [ M ]  =  [u]T[m][u]  is  the  modal  mass  matrix, 

[K]  =  [u]T[k][u]  is  the  modal  stiffness  matrix. 

Orthogonality  of  the  modal  matrices  diagonalize  the  mass 
and  the  stiffness  matrices  (given  that  they  are  constant  and 
symmetric) .  It  is  common  to  normalize  the  mass  matrix  to  an 
identity  matrix.  Multiplying  by  the  inverse  of  the  identity 
mass  matrix  makes  the  stiffness  matrix  equal  to  the 
eigenvalues  since  o2  =  K/M.  The  final  form  of  the  EOM  is  then 

[I]  (r?(t)  }  +  O2]  { r?  ( t )  }  =  { N  ( t )  }  (4.9) 

This  form  of  the  EOM  is  readily  available  from  finite  element 
computer  programs  such  as  ANSYS.  Eqn  4.8  can  be  put  into  the 
state-space  form  of  Eqn  2.8 


'o  i 

M 

+ 

0 

-[to2]  o. 

ViJ 

UT0 . 

(4.10) 


where 


u  is  the  input  control  force, 
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Linear  transformation  must  also  be  applied  to  y  =  Cx  to  get 
the  output  matrix  in  the  state  space  equation  form. 

Y  =  C[u]  [rj  r?]T  (4.11) 

Thus,  the  state  space  equation  for  output  becomes 

Y  =  [  C[u]  |  0  ]x 

The  matrix  C  is  padded  with  zeros  to  match  the  size  of  the 
state  vector  x  (since  no  velocity  measurements  are  taken) . 
The  C  matrix  in  Eqn  4.11  for  a  single  output  case  will  be  a 
row  matrix  of  size  1  x  n  with  ones  at  the  nodes  of  interest. 


4 . 4  TEN  ELEMENT  TRANSVERSE  BEAM  EXAMPLE 

To  show  that  the  FEM  can  produce  the  [A],  [B],  and  [C] 
matrices  required  for  the  state-space  equations,  a  ten  element 
transverse  beam  is  modelled  in  ANSYS.  See  Appendix  B  for  the 
ANSYS  data  input  file. 
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The  two  dimensional  beam  element  (STIF  3)  is  an  uniaxial 
element  with  tension-compression  and  bending  capabilities.  It 
has  three  DOF  at  each  node:  translation  in  the  x  and  y 
direction;  and  rotation  about  the  z  axis. 


For  this  example  problem  because  bending  is  the  primary 
mode  of  interest,  x  translational  DOFs  were  neglected.  The 
ten  element  beam  has  a  total  of  40  DOF  (4  DOF/element  x  10 
elements) .  Eliminating  the  DOFs  at  the  internal  nodes  due  to 
the  constraints  results  in  total  of  22  unkown  DOF.  Solving 
this  free-free  beam  using  modal  analysis  in  ANSYS  produces  a 
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22x22  modal  matrix,  [u]  ,  assoicated  with  the  DOF 


DOF 


■y  i 


zl 


U. 


yii 


'zil 


The  A  matrix  is  formed  from  the  mass  and  stiffness  matrices, 
but  ANSYS  has  normalized  the  mass  matrix  to  identity  so  that 
A  can  be  derived  by  Eqn  4.9.  The  A  matrix  is 


0 22x22 

-[a2] 22x22 


j~22x22‘ 
q22 x22 


ANSYS  outputs  the  eigenvalues  in  natural  frequencies  in  units 
of  cycles  per  time  and  must  be  converted  to  radians  per  time 
before  using  in  the  A  matrix.  Listed  in  Table  4.1  are  the 
eigenvalues  from  Ansys  compared  to  the  closed  form  solution 
for  free-free  transverse  beams  [14:275]. 

Table  4.1  Eigenvalues  from  Ansvs  and  the  Closed  Form  Solution 
Ansys  Closed  Form  Solution  Error 


0.0  Hertz 

0.0 

0 . 0 

0.0 

0 . 0 

0.0 

4 . 072 

4 . 088 

0.4 

11 . 196 

11.259 

0.6 

21 . 884 

22 . 080 

0.9 
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Note  the  first  two  inodes  are  the  rigid  body  inodes  (X  =  0.0). 
The  error  is  less  than  one  percent  for  the  first  five  inodes, 
which  shows  the  accuracy  of  the  model  with  the  full  twenty-two 
modes.  Later  section  will  compare  the  eigenvalue  solution  for 
just  four  modes.  The  Q  force  matrix  is 


0  = 


0 

0 

0 


1 


where  1  has  been  placed  at  the  21st  row  representing  node  11 
in  the  y  direction.  Therefore  the  B  matrix  is 


B  = 


'  0  ' 
UTQ_ 


where  UTQ  is  the  21st  row  of  the  transposed  modal  matrix. 
The  output  matrix  is 


£  = 


1 

0 


0  0  0  -  0  0 

0  0  0  -  1  0 
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where  the  ones  represent  a  displacement  sensor  at  node  1  (non- 
colocated)  and  node  11  (colocated) .  Remembering 


C  =  [C[u](2x22)  J  0(2x22)] 

where  C[u]  becomes  the  1st  row  and  the  21st  row  of  the  modal 
matrix,  [u] . 

4.4.1  MODEL  REDUCTION  TO  FOUR  MODES 


Because  of  the  large  size  of  the  A  matrix  (44x44),  the 
model  was  reduced  to  only  the  first  four  modes.  For  the  ten 
element  beam,  going  from  twenty-two  to  four  modes  still 
produced  accurate  results  for  the  first  two  flexible  poles. 
This  is  evident  by  examining  Figures  4.6  and  4.7.  The  Bode 
plot  of  the  reduced  beam  with  four  modes  is  compared  with  the 
frequency  response  spectrum  from  ANSYS  (KAN  6  Analysis) .  In 
this  way,  two  different  methods  are  used  to  find  the  transfer 
function  between  input  and  output  for  a  beam. 

The  reduction  produced  a  8x8  A  matrix  containing  the  mode 
shapes  of  interest.  The  first  four  eigenvalues  are  still  very 
accurate  to  the  closed  form  solution  shown  in  Table  4.1. 
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X 


Hertz 


=  0.0 
0 . 8'7ie-6 
4.232 
12 . 727 


The  second  mode  is  the  rigid  body  rotation,  so  the  value  was 
made  zero.  The  first  flexible  pole  is  accurate  to  within  3.5 
percent  of  the  closed  form  solution.  See  Figure  4.8  for  the 
mode  shapes  associated  with  the  eigenvalues. 
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Figure  4.6  Bode  Plot  Comparing  Frequency  Response 
of  11  Modes  to  the  Reduced  4  Modes  for  the 
Colocated  Beam 


Figure  4.7  Bode  Plot  Comparing  the  Frequer.c^ 
Response  of  11  Modes  to  the  Reduced  4  Modes  for  the 
Non-colocated  Beam 
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The  final  A  matrix  is 


0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-7.06X102 

0 

0 

0 

0 

0 

0 

0 

0 

-6. 39X103 

0 

0 

0 

0 

The  B  matrix  is 

0 

0 

0 

0 

B  = 

3 . 288 
3.727 
3 . 393 
4.128 


The  C  matrix  is 


3.288  0.727  3.393  4.128  0000 

C  = 

-2.272  2.485  3.654  -3.011  0  0  0  01 


The  eigenvalues  of  the  A  matrix  are  the  system  poles  and 
the  transmission  zeros  are  found  using  the  tzero  command  in 
MATLAB.  They  are  listed  in  Table  4.2. 
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Table  4.2  Poles  and  Zeros  of  the  Ten  Element  Beam 


Poles  Colocated  Zeros  Non-colocated  Zeros 

0 , 0 , 0 , 0  r/s  0,0  0,0 

±26. 59 i  ±18.32i  ±32.52 

±79 . 97 i  ±61 . 89 i  ±65.20 

Note  the  extra  pair  of  zeros  for  the  second  rigid  body  motion 
is  canceled  by  the  pair  of  zeros  for  the  colocated  and  non- 
colocated  zeros.  This  pole/zero  cancellation  did  not  cause 
observability  problems.  Shown  below  is  the  Bode  plot  of  the 
open  loop  plant  for  both  the  colocated  and  non-colocated 
systems.  Note  the  dips  in  the  colocated  plot  indicating  it 
has  imaginary  zeros ; whereas ,  the  non-colocated  has  no  dips 
because  its  zeros  are  on  the  real  axis.  The  non-colocated  low 
freguency  gain  is  little  less  than  the  colocated 
gain;therefore,  a  pre-filter  gain  of  2  is  required  to  the 
input  of  the  B  matrix  to  make  the  two  systems  equal  for 
comparison  purposes. 
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Figure  4.9.  Bode  Plots  of  the  Colocated  and  Non- 
colocated  Ten  Element  Beam 
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4 . 5  LOG/LTR  CONTROL  DESIGN  ON  THE  BEAM 


The  control  design  on  the  transverse  beam  produced 
interesting  results.  The  control  design  without  LTR  (the 
fictitious  noise  parameter  q  =  0  )  ,  resulted  in  the  colocated 
system  being  robust  to  large  gain  variations  (from  0.5  to  43)  . 
The  non-colocated  system  did  not  improve  with  LTR  as  expected 
of  a  non-minimum  phase  system. 

Both  systems  were  designed  to  have  the  same  bandwidth  of 
about  8  rad/sec.  Figure  4.10  represents  the  Bode  plot  of  the 
closed  loop  bandwidths  for  both  cases.  The  weighting  matrices 
used  for  the  LQR  for  the  colocated  case  is 

Qc  =  diag  ( 105  105  105  105  103  103  103  103)  , 

and  for  the  non-colocated  case  is 

Qc  =  diag(104’5  104-5  104  104  103  103  103  103)  . 

For  both  cases,  the  noise  intensity  at  the  input  for  the  LQE 
was  selected  as 

Q0  =  105  • 
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Figure  4.10  Closed  Loop  Bandwidths  for  the  Ten 
Element  Beam 


The  root  locus  plots  show  the  poles  of  the  closed  loop 
system  as  gain  is  varied.  The  colocated  system  went  unstable 
at  gain  of  k  =  43.  See  Figure  4.11.  This  system  became  less 
robust  after  LTR  for  q2  =  109.  Then  the  system  started  to 
increase  in  robustness  until  the  gain  value  exceeded  100. 
Observing  the  LTR  plots  of  Figure  4.13  clearly  shows  that  the 
system  gained  the  robustness  of  a  full-state  regulator.  See 
Table  A.  2  in  Appendix  A  for  the  results  from  the  design 
iterations.  Figures  4.14  shows  the  root  locus  plot  for 
q2  =  1012.  Note  the  highest  frequency  pole  is  the  one  that 
goes  unstable.  So,  this  system  is  very  robust  for  the  lower 
frequency  poles. 


4 


20 


The  non-colocated  case  was  not  able  to  get  full  loop 
recovery  no  matter  how  much  fictitious  noise  was  added.  In 
fact,  gains  after  q  =  1012  made  no  improvement  on  the  low 
frequency  recovery.  See  Figure  4.15  for  the  LTR  plots.  The 
poles  became  unstable  after  a  gain  of  k  =  2  for  all  q2  values. 
See  Table  A. 2  in  Appendix  A.  The  root  locus  plot  for  q2  =  1012 
is  shown  in  Figure  4.16.  This  plot  clearly  shows  the  poles 
moving  toward  the  right  half  plane  zeros. 


ROOT  LOCUS 


REAL  AXIS 


Figure  4.11  Root  Locus  for  the  LQG  Design  Without  LTR  for 
the  Colocated  System 
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Figure  4.12  Root  Locus  for  the  LQG  Design  Without  LTR  for 
the  Non-colocated  System. 
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Figure  4.14  Root  Locus  for  the  LQG  Design  with  LT 
R  for  the  Colocated  System 
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Figure  4.16  Root  Locus  for  the  LQG  Design  with  LTR 
for  the  Non-colocated  System 


4 


24 


4 


25 


4.6  CONCLUSION 


For  the  ten  element  beam  after  large  amounts  of 
fictitious  noise  was  added,  the  colocated  system  became  very 
robust  as  it  approached  the  target  full-state  regulator.  On 
the  other  hand,  the  non-colocated  system  did  not  get  any 
recovery  for  any  value  of  fictitious  noise.  The  RMS  response 
of  the  colocated  system  was  also  much  less  than  the  non- 
colocated  system.  See  Table  A. 2  in  Appendix  A. 

The  step  response  for  both  systems  had  similar  results  as 
the  three  element  lumped  mass  example.  The  colocated  system 
had  ringing  in  its  rise  curve  due  to  the  lightly  damped  poles 
and  the  influence  of  the  zeros  on  the  imaginary  axis.  The 
non-colocated  rise  curve  had  the  initial  negative  rise 
associated  with  the  RHP  zero. 

Reviewing  the  closed  loop  pole  locations  show  that 
LQG/LTR  designs  agree  with  theory.  As  q2  is  increased  for 
the  colocated  system,  the  Kalman  filter's  closed  loop  poles 
notches  out  the  plant  zeros.  Meanwhile,  the  LQG/LTR 
compensator  zeros  move  toward  the  closed  loop  poles  of  the 
full-state  regulator.  In  turn,  the  root  locus  shows  the 
plant's  poles  moving  toward  the  compensator  zeros  during 
feedback.  This  is  clear  in  Figure  4.15  of  the  non-colocated 
system  which  shows  the  filter  poles  notching  out  the  plant 
zeros  in  the  LHP.  Thus,  the  compensated  feedback  system 
achieves  the  robustness  of  a  full-state  regulator.  The  non- 
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colocated  system  can  not  achieve  loop  recovery  since  it  has 
RHP  zeros  which  prevent  the  Kalman  filter  poles  from  notching 
out  the  zeros.  However,  the  colocated  system  has  higher  noise 
which  seems  to  cause  the  design  trade-off  in  improving  system 
robustness  with  LTR. 
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V.  FINITE  ELEMENT  MODEL  OF  CONTRAVES  P52F  GIMBALS 


5. 1  FINITE  ELEMENT  MODELING 


The  gimbal  structure  used  in  this  investigation  is  a 
target  motion  simulator  built  by  Contraves  USA.  This  gimbal 
must  be  robust  to  parameter  variations  because  ±t  must 
accomodate  many  different  types  of  missiles  for  testing.  The 
control  design  must  be  able  to  handle  the  changes  in  the  mass 
and  inertia  of  the  different  payloads. 

The  gimbal  has  an  inner  (azimuth  axis)  and  an  outer 
(elevation  axis)  gimbal  arrangement.  The  gimbal  is  driven  by 
hydraulic  actuators  that  provide  torque  and  uses  position  and 
torque  transducers  (sensors) .  The  torque  for  the  finite 
element  model  is  applied  on  a  node  on  the  inner  gimbal  at 
point  A  in  Figure  5.1.  Point  A  is  also  the  location  of  the 
colocated  sensor  and  Point  B  is  the  location  for  the  non- 
colocated  sensor.  The  two  gimbals  are  connected  together  by 
a  pipe  element  (STIF  12)  with  soft  beam  elements  (STIF  3) 
representing  the  bearing  connection  that  simulates  the 
rotation  of  the  inner  gimbal.  For  this  thesis,  the  outer 
gimbal  was  fixed  against  rotation.  The  model  is  three 
dimensional  in  that  it  has  all  six  DOF  (xyz  translation  and 
rotation)  associated  with  the  nodes. 
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The  ANSYS  model  in  Figure  5.1  has  over  one  thousand 
elements.  Because  of  the  large  number  of  modes  available,  the 
modal  analysis  used  only  the  first  five  modes. 
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This  truncated  model  produced  the  following  eigenvalues  in  its 
natural  frequency  form. 


X  =  1.418  Hz 

13.736 
61.460 
3940.861 
4761.030 


The  first  mode  was  found  to  be  the  rigid  body  mode  of  the 
inner  gimbal .  So,  this  frequency  was  taken  as  zero.  The  mode 
shape  plot  of  Figure  5.2  shows  the  rotation  (the  solid  shape) 
and  the  dotted  line  representing  the  original  shape.  The 
second  mode  caused  a  pole/zero  cancelation  and  was  omitted 
from  the  analysis.  The  last  two  eigenvalues  are  at  very  high 
frequencies.  Thus,  the  only  effective  flexible  pole  is  the 
third  mode  at  61.46  Hz  or  386.2  rad/sec. 

Table  5.1  Poles  and  Zeros  of  the  Contraves  Model _ 


Poles 


Colocated  Zeros  Non-colocated  Zeros 


0,0 

±386. 2i 
±24761. 0i 
±29914 . 0i 


±173 .6i 
±2247 . 8i 
±26915. Oi 


±229 . 7 
±8667 . 1 

0. 0  ±  11631. 0i 


Note  Table  5.1  shows  the  non-colocated  case  has  an  imaginary 
zero.  This  is  not  that  unusual  and  is  the  result  of  modal 
truncation.  The  bode  plot  shows  the  poles  and  zeros  in  Figure 
5.3. 
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Figure  5.2  The  First  Mode  Showing  the  Rigid  Body 
Rotation 
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Figure  5.3  Bode  Plots  of  the  Colocated  and  Non- 
colocated  Contraves  Model 


The  accuracy  of  the  truncation  compared  to  the  frequency 
response  of  the  structure  shows  the  dominant  pole  at  386 
rad/sec  was  matched  very  well.  But,  the  frequency  response 
shows  there  is  also  another  pole/zero  pair  near  250  rad/sec 
that  the  truncated  model  does  not  have.  See  Figures  5.4  and 
5 . 5  on  the  next  page.  Considering  the  fact  this  model  has  all 
six  DOF  and  our  sensor  is  only  taking  the  rotational 
measurement,  the  author  considers  this  to  be  an  acceptable 
since  the  closed  loop  bandwidth  is  at  100  rad/sec  which  is 
below  this  first  pole  at  250  rad/sec.  A  position  sensor 
located  elsewhere  on  the  model  may  sense  the  pole  missed  by 
the  sensor  located  at  points  A  and  B  in  Figure  5.1.  Then  the 
control  problem  becomes  single  input  and  multi-output;  but, 
this  thesis  is  only  examining  the  SISO  case. 
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Figure  5.4  Truncated  Model  Compared  to  the 
Frequency  Response  for  the  Colocated  Case 


Figure  5.5  Truncated  Model  Compared  to  the 
Frequency  Response  for  the  Non-colocated  case 
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Further  investigation  was  done  to  better  match  the 
fr°quency  response  curve  by  using  a  MATLAB  script  file  ANSYS.M 
written  by  Professor  Bradley  Liebst  to  do  a  least  squares  fit. 
This  method  produces  a  transfer  function  in  polynomial  form. 
The  curve  fit  modeled  the  first  two  flexible  poles  well  and 
produced  an  eighth  order  polynomial.  See  Figure  5.6. 


However,  converting  from  transfer  function  to  state  space 
produced  a  poorly  conditioned  (A,  B,  C,  D)  representation.  It 
appears  the  most  numerically  reliable  method  for  state  space 
design  is  using  the  FEM  modal  analysis  presented  in  Chapter  4. 
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5 . 2  LOG/LTR  DESIGN  ON  THE  GIMBAL 


The  final  A  matrix  after  truncation  and  reduction  is 
8  x  8  in  size.  The  state  weighting  selected  for  the  colocated 
system  is 

Qc  =  diag  ( 106  106  103  103  102  102  10  10), 

and  for  the  non-collocated  sytem  is 

Qc  =-  diag ( 105-5  105-5  103  103  10?  102  10  10) 

For  both  cases,  the  noise  intensity  at  the  input  was  modeled 
as 


Q0  =  lo7- 

The  closed  loop  bandwidth  for  the  LQG  designs  are  shown 
in  Figure  5.6  where  the  crossover  frequency  is  defined  as  -3dB 
below  the  OdB  axis. 
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BODE  PLOT 


FREQ  (Pod/Sec) 


Figure  5.7  Closed  Loop  Bandwidths  for  the 

Contraves  Model 


The  LQG  design  without  LTR  for  the  colocated  case 
produced  a  system  that  went  unstable  at  gain  k  =  5.5.  The 
non-colocated  system  went  unstable  at  k  =  2.5.  Interestingly, 
the  LQG  design  for  both  systems  placed  compensator  zeros  in 
the  RHP.  It  was  not  until  the  fictitious  noise  value  became 
q2  =  109  did  the  all  the  colocated  compensator  zeros  move  into 
the  LHP.  At  this  time,  the  system  became  very  robust  and  it 
went  unstable  at  k  =  25.  The  non-colocated  case  never  gained 
any  robustness  after  LTR.  Its  compensator  zeros  remained  in 
the  RHP  for  all  fictitious  noise  values.  See  the  results  in 
Table  A.  3  in  appendix  A.  The  loop  transfer  recovery  plots  and 
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the  root  locus  plots  for  the  colocated  and  non-colocated  cases 
are  shown  on  the  following  pages. 
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Figure  5.8  LTR  for  the  Colocated  System 
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Figure  5.9  Root  Locus  for  the  LQG  Design  with  LTR 
for  the  Colocated  System 
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Figure  5.10  LTR  for  the  Non-colocated  System 


Figure  5.11  Root  Locus  for  the  LQG  Design  with  LTR 
for  the  Non-colocated  System 


5 . 3  STEP  RESPONSE 


The  step  response  of  Figure  5.12  shows  the  colocated  and 
non-colocated  systems  having  similar  rise  times.  Both  systems 
have  good  damping  of  its  poles  with  the  colocated  showing  a 
small  fluctuation  due  to  its  zero  on  the  imaginary  axis.  The 
non-colocated  system  because  it  has  RHP  zeros  has  the  initial 
negative  rise  in  its  step  reponse. 


STEF'  PE$PC*!SL 


J  ‘  0  O.ci  0.C2  0.0.3  0  04  0.05  0.06  0.07  0  08  0.00  '  1 

TIME  (sec) 

Figure  5.12  Step  Response  of  the  Contraves  Ginbal 
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5.4  CONCLUSION 


The  non-colocated  system  since  it  was  non-minimum  phase 
could  not  recover  any  robustness  with  LTR .  On  the  other  hand, 
the  colocated  system  after  sufficient  fictitious  noise  was 
added  at  the  plant  input  increased  its  robustness.  See  Table 
A. 3  in  Appendix  A. 

The  RMS  noise  responses  for  the  colocated  system  was 
generally  larger  than  the  non-colocated  system  due  to  the 
larger  Qc  weighting  matrix  used.  The  unit  step  input  response 
revealed  the  negative  rise  expected  from  non-minimum  phase 
systems  for  the  non-colocated  case.  Both  rise  times  were  the 
similar  and  both  had  good  damping. 

Some  modeling  inaccuracies  were  introduced  by  modal 
truncation  of  the  very  large  system  to  only  the  first  five 
modes.  Even  then,  one  of  the  modes  proved  to  be  unobservable 
and  had  to  be  removed  from  the  analysis.  More  analysis  with 
higher  order  models  might  be  needed  to  more  accurately  model 
the  system. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS 


6.1  SUMMARY 


Chapter  II  introduced  the  three  element  lumped  mass  model 
to  illustrate  basic  principles  of  pole/zero  patterns 
associated  with  different  cases  of  sensor  and  actuator 
locations.  The  colocated  system  (sensors  and  actuators  at  the 
same  location)  has  the  desirable  property  of  alternating  poles 
and  zeros  on  the  imaginary  axis.  This  pole/zero  pattern  makes 
it  easy  to  stabilize  the  system  with  a  simple  leed 
compensator.  The  non-colocated  system  could  not  be  stabilized 
with  a  lead  compensator.  Because  the  three  element  model  is 
a  single  motion  DOF  system,  it  did  not  have  any  RHP  zeros. 
But,  it  exhibited  non-minimum  phase  like  behavior.  The  non- 
colocated  system  required  a  higher  order  controller  to 
stabilize  it. 

Chapter  III  introduced  the  LQG/LTR  theory  used  to  design 
the  higher  order  controller  for  the  non-colocated  system. 
Despite  large  fictitious  noise  added,  loop  recovery  was 
limited  and  marginally  successful  only  at  low  frequencies.  It 
maintained  its  high  frequency  roll-off  characteristic  of  a 
non-minimum  phase  system. 
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To  show  RHP  zeros  of  a  non-minimum  phase  system,  Chapter 
IV  introduced  the  FEM  and  the  ten  element  transverse  beam. 
This  model  exhibited  the  RHP  zeros  for  the  non-colocated  case. 
As  expected  of  a  non-minimum  phase  system,  LTR  had  little 
effect  on  improving  the  robustness  in  comparison  to  the 
colocated  system.  Because  the  LTR  theory  relies  on  placing 
the  poles  of  the  Kalman  filter  at  the  plant's  zeros,  the  RHP 
zeros  make  this  impossible  to  accomplish.  For  the  colocated 
system,  LQG  design  without  LTR  was  sufficient  to  make  it  very 
robust.  However,  LTR  made  the  system  much  more  robust  as  it 
approached  the  robustness  of  the  target  full-state  loop. 

Chapter  V  designed  the  LQG/ LTR  controllers  for  the 
Contraves  gimbal.  The  final  results  were  similar  to  the  ten 
element  beam.  LTR  made  the  colocated  system  more  robust, 
although  the  robustness  did  not  increase  linearly.  Of  course, 
the  non-colocated  system  which  had  RHP  zeros  had  unsuccessful 
LTR. 

This  finite  element  model  was  much  more  complex  than  the 
beam ; therefore,  modal  truncation  did  not  model  one  of  the 
system's  flexible  poles  at  250  rad/sec.  However,  this 
flexible  pole  was  above  the  design  bandwidth  of  100  rad/sec. 
The  author  considered  the  system  to  be  accurate  enough  for 
design  comparisons. 

Interesting  observations  were  made  concerning  the  LQG/LTR 
controllers.  LQG  design  is  helped  by  LTR  because  as  the 
fictitious  noise  is  increased,  the  compensator  poles  move 
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toward  the  open  loop  plant  zeros  to  notch  them  out.  The 
Kalman  filter  accomplishes  this  task  since  its  closed  loop 
poles  (A  -  KfC)  at  high  q2  values  moves  to  the  plant  zeros. 
On  the  other  hand,  the  compensator  zeros  move  toward  the 
stable  poles  of  the  closed  loop  regulator  ( A-BKc )  .  Thus, 
during  compensated  feedback  the  plant  poles  move  to  the 
compensator  zeros  which  recovers  the  robustness  of  the  full- 
state  regulator. 

The  two  designs  are  compared  in  Table  6.1.  The  following 
were  used  as  criteria: 

A.  Robustness 

1.  Gain  at  which  the  root  locus  goes  into  the  RHP 

2.  Whether  full  recovery  to  the  target  full  state  loop 
is  achieved 

3.  Alternating  poles  and  zeros  indicating  whether  a 
system  can  be  easily  stabilized 

B.  Performance 

1.  Bandwidth 

2 .  Step  response 

-  settling  time 

-  ringing 

-  initial  negative  response  or  no  response 

3.  Damping 

4.  RMS  noise  response 
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C.  Designability 

1.  RHP  compensator  poles 

2.  High  frequency  roll  off 

3.  State  weighting  required 

Table  6.1  Comparison  of  Colocated 

l 

and  Non-colocated  Systems 

COLOCATED  DESIGN 

NON-COLOCATED  DESIGN 

A.  1: 

Robust  to  gain  variations 

Not  robust  to  gain 

variations 

A. 2: 

LTR  is  possible  over  a 
large  bandwidth 

LTR  is  not  achieved, 
especially  at  high 
frequency 

A.  3 : 

Has  alternating  poles/zeros 

No  alternating  pattern 

B.  1: 

Lower  bandwidth  achievable 

Higher  bandwidth  achievable 

B.  2  : 

-  Faster  settling  time 

-  Ringing 

-  n/a 

-  Slower  settling  time 

-  No  ringing 

-  Initial  negative  response 

B.  3  : 

Poorly  damped  poles 

Poles  damped  well 

B.  4  : 

Higher  RMS  response 

Lower  RMS  response 

C.  1: 

Compensator  can  have  RHP  poles  for  both  systems 

C .  2 : 

No  high  frequency  roll-off 

High  frequency  roll-off 

C.  3 : 

Larger  state  weighting 
matrix  required  to  match 
bandwidth 

Smaller  state  weighting 
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6.2  CONTRIBUTION 


It  appears  each  system  has  its  own  advantage.  The 
colocated  system  is  very  robust  and  can  handle  large  gain 
variations.  But,  the  colocated  system  for  a  given  state 
weighting  matrix  can  not  achieve  the  same  bandwidth  the  non- 
colocated  system  can.  If  performance  was  more  important  than 
robustness,  the  non-colocated  system  may  be  desired.  Of 
course,  one  has  to  live  with  the  initial  negative  response  of 
a  non-minimum  phase  system.  Therefore,  the  control  engineer 
can  determine  whether  to  go  with  colocation  or  non-colocation 
depending  on  the  specifications  that  are  required. 


6.3  RECOMMENDATION  FOR  FURTHER  STUDY 


To  continue  to  the  research  on  the  effects  of  colocation 
and  non-colocation  of  sensors  and  actuators,  several  other 
factors  need  to  be  evaluated.  The  selection  of  the  state 
weighting  matrix,  Qc,  seems  to  have  a  major  influence  on  the 
bandwidth,  damping,  and  the  noise.  Several  references  should 
be  investigated  further  in  selecting  the  weighting  matrices. 
Major  Michael  DeLorenzo  presents  an  algorithm  for  efficient 
weight  selection  techniques  in  Reference  2.  One  more  source 
that  should  be  examined  is  Gunter  Stein  and  Michael  Athans 
paper  LOG/LTR  Procedure  for  Multivariable  Feedback  Control 
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Design.  They  also  introduce  a  formal  weight  augmentation 
procedure  that  should  be  investigated.  Further  LQG/LTR  design 
iterations  should  be  attempted  based  on  the  optimum  Qc 
selected. 

Second,  the  noise  from  the  LTR  procedures  need  to  be 
evaluated  to  see  what  influence  it  has  on  the  robustness  and 
to  quantify  when  it  drives  systems  unstable.  Third,  more 
different  modal  truncations  need  to  be  tried  on  the  Contraves 
gimbal  to  model  all  the  low  frequency  poles.  However,  it  may 
require  additional  sensors  to  observe  the  modes  that  are  not 
observable  with  a  rotational  sensor.  Thus,  further  research 
on  the  effects  of  colocation  and  non-colocation  should  be  done 
on  multi-input  and  multi-output  systems. 
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Appendix  A:  LOC/LTR  Design  Resulcs 


Table  A.l  LQG/LTR  Design  Results  of  the  Three  Element  Model 


q2 

RHP  K (s) 
poles* 

RHP  K ( s) 
zeros* 

RMS 

Response 

Root  Locus 
gain  k** 

CO 

non 

CO 

non 

CO 

non 

CO 

non 

0 

no 

no 

no 

yes 

1.00 

1.14 

30 

1 . 75 

103 

no 

no 

no 

yes 

1.25 

1.02 

30 

1.75 

106 

no 

yes 

no 

no 

3.51 

2.46 

17 

1.25 

109 

no 

yes 

no 

no 

7.46 

4 . 06 

6.5 

1.5 

1012 

no 

no 

no 

no 

11.27 

3 . 54 

8 . 0 

1 . 5 

1015 

no 

no 

no 

no 

12.41 

3 . 00 

28 . 5 

2 . 0 

CD 

CO 

no 

no 

no 

no 

12 . 61 

2 . 66 

30 

2 .75 

1020 

no 

no 

no 

no 

12 . 61 

2 . 44 

30 

4 . 0 

Note : 


q2  =  fictitious  noise  value 

*  =  "yes"  means  compensator  has  RHP  poles  or  zeros  for  the 
colocated  or  non-colocated  systems 

**  =  the  gain  value  of  the  closed  loop  compensator  and  plant 
when  its  eigenvalues (the  poles)  goes  into  the  RHP 
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Table  A. 2  LQG/LTR  Design  Results  of  the  Ten  Element  Beam 


q2 

RHP  K(s) 
poles* 

RHP  K(s) 
zeros* 

RMS 

Response 

Root  Locus 
gain  k** 

CO 

non 

CO 

non 

CO 

non 

CO 

non 

0 

no 

no 

no 

yes 

4.8 

156 

43 

2 

103 

no 

no 

no 

yes 

5.8 

1 . 5i 

36 

2 

106 

no 

no 

no 

yes 

6.1 

582 

34 

2 

109 

no 

no 

no 

yes 

10.8 

8 . 6e4 

15 

2 

1012 

no 

no 

no 

yes 

12 . 3 

530 

37 

2 

1015 

no 

no 

no 

yes 

12 . 4 

9 . 3e3 

199 

2 

1018 

no 

no 

no 

yes 

12.4  t 

.  6e3 i 

1100 

2 

Table  A. 3  LQG/LTR  Design  Results  of  the  Contraves  Gimbal 


q2 

RFP  K(s) 
poles* 

RHP  K (s) 
zeros* 

RMS 

Response 

Root 

gain 

Locus 

L*  * 

CO 

non 

co 

non 

CO 

non 

CO 

non 

0 

no 

no 

yes 

yes 

40.9 

39 . 1 

5.5 

2 . 5 

103 

no 

no 

yes 

yes 

42 . 3 

41.7 

7 

2 

106 

no 

no 

yes 

yes 

95.0 

67.5 

3 

2 

109 

no 

no 

no 

yes 

239 

157 

25 

2 

1012 

no 

no 

no 

yes 

509 

247 

8 

2 

1015 

no 

no 

no 

yes 

885 

389 

6.5 

2 

1018 

no 

yes 

no 

yes 

1044 

3209 

17 

2 

Ten  Element  Beam  Model 


/PREP7 

/TITLE,  Free-Free  Beam  with  E  =  1000 

KAN  ,2 
KAY, 2, 5 
KAY, 3,1 

/COM  NODE  DEFINITIONS 
CSYS ,  0 

N,  1,  0.,  0.,  0. 

N,  2,  300.,  0.,  0. 

N,  3,  600. ,  0. ,  0. 

N,  4,  900.,  0.,  0. 

N,  5,  1200.,  0.,  0. 

N,  6,  1500.,  0.,  0. 

N,  7,  1800.,  0.,  0. 

N,  8,  2100.,  0.,  0. 

N,  9,  2400.,  0.,  0. 

N,  10,  2700.,  0.,  0. 

N,  11,  3000.,  0.,  0. 

/COM  Real  constant  table 

RSIZE ,  10 

R,  1,  15000.,  1.25E+07,  100. 

/COM  Material  properties 

MP, EX ,  1,  1000 

MP , NUXY ,  1,  3 . 000000E-01 

MP, DENS ,  1,  7 . 8330000E-09 

MP , ALPX ,  1,  0 . 000000E+00 


/COM  Element  type  table 

ET,  1,  3,  0,  0,  0,  0,  0,  0 

/COM  ELEMENT  DEFINITIONS 

TYPE,  1  $  REAL,  1  $  MAT,  1 


EN,  1,  1,  2 
EN,  2,  2,  3 
EN,  3,  3,  4 
EN,  4,  4,  5 
EN,  5,  5,  6 
EN,  6,  6,  7 
EN,  7,  7,  8 
EN,  8,  8,  9 
EN,  9,  9,  10 
EN,  10,  10,  11 

DDELE ,  1,  ALL,  11 

/COM  NODAL  DISPLACEMENT  RESTRAINTS 

D, all , UX, 0 
D, all , rotz , 0 

/COM  Load  set  1 

M , 1 , uy 

M, 11 , uy 

TOTAL, 4 
ITER, 4 ,1,1 

/COM  NODAL  FORCES 

F,  11,  FY,  1. 

FREQ, 100, 25000 
SV,  , 1, 1 
SVTYPE , 1 

LWRITE 

AFWRITE 

FINISH 

/OUTPUT, mode4E, out 
/EXE 

/INPUT, 27 
FINISH 
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Contraves  P52F  Gimbal 


C***  PARAMETRIC  52T  PARAMETERS 
C***  PAYLOAD 

*SET , PWT ,200  *  "PAYLOAD  WEIGHT  ,  POUNDS" 

*SET , PCG , 18  *  CG  ABOVE  MOUNTING  SURFACE 

*SET, ELAC, 1200  *  DEG/SECA2 

*SET, AZAC, 1200  *  DEG/SEC A  2 

*SET , RINT , 54  *  RADIUS  TO  INTERFACE  SURFACE 

C***  INTERFACE  PLATE 
*SET , D1 , 2  5  *  WIDTH 

*SET , D2 , 2 5  *  "LENGTH  ,  AZ  AXIS  DIRECTION" 

*SET , T1 , 1.25  *  THICKNESS 

*SET , D3 , 2 0  *  THRU  HOLE  DIA 

C***  INNER  GIMBAL 

*SET , Ml , 2  *  MATERIAL  STEEL= 1  ALUMINUM=2  CAST 

I RON=  3 

*SET ,  D4 , 4  *  NARROW  SECTION  THICKNESS 

*SET ,  D8  , 10  *  THICK  SECTION  THICKNESS 

*SET,T2 , 0 . 3125  *  WALL  THICKNESS 

*SET , D5 , 1 1  *  HALF  WIDTH 

*SET , D6 , 4 2  *  CL  TO  AZ  HUB 

*SET , D7 , 5  *  HUB  HALF  HEIGHT 

C***  CALCULATED 

*SET,RI1, 31. 156  *  INNER  RADIUS  BASED  ON  WIDTH  (PLATE 

CL) 

*SET, RI2 , 45 . 156  *  INNER  RADIUS  BASED  ON  HEIGHT 

*SET,RI, 31. 156  *  LESSER  OF  ABOVE 

*SET, RO, 25 . 918  *  OUTER  RADIUS 

*SET , Z 1 , 11  *  Z  COORD  OF  RI 

*SET ,  XI  , 18.5  *  X  COORD  OF  RI 

*SET, Z2 , 19 . 926  *  Z  COORD  OF  RO 

*SET, X2 , 27 . 457  *  X  COORD  OF  RO 


C***  AZIMUTH  ACTUATOR 

*5ET , D50 , 1 . 968  * 

*S£T, D51 , 0 . 750  * 

*SET, D53 , 3 . 125  * 

*SET, D54 , 6. 300  * 

*SET,T50, 2 . 000  * 
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SHAFT  OUTSIDE  RADIUS  UNDER  RINGFEDER 

SHAFT  WALL 

BEARING  OUTER  RADIUS 

ENDPLATE  OUTER  RADIUS 

ENDPLATE  THICKNESS 


*SET, D55, 4 . 520  *  STATOR  BORE 

*SET, D56, 1.950  *  STATOR  LENGTH 

*SET , YAX , 2E+06  *  1/2  HERTZIAN  AXIAL  BEARING  STIFFNESS 

*SET, YRAD, 4E+06  *  1/2  HERZIAN  RADIAL  STIFFNESS 

C***  CALCULATED 

*S^T, AA, 0.273  *  4  BEAM  BEARING  AREA 

*SET, AIYY, 0. 073  *  4  BEAM  BEARING  INERTIA 

*SET , D57 , 4 8 . 8  *  INNER  ENDPLATE  LOCATION 

*SET ,D58,55.270  *  OUTER  ENDPLATE  LOCATION 


C***  OUTER  GIMBAL 

*SET , M2 , 2  *  MATERIAL  STEEL=1  ALUMINUM=2  CAST 

IRON=3 

*SET,T60, 0. 313  *  GIMBAL  WALL 

*SET,T61, 0.750  *  HUB  WALL 

*SET, D61 , 5. 000  *  GIMBAL  DEPTH  AT  YAW  HUB  (YAW  AXIS  DIR) 

*SET, D62 , 5 . 000  *  GIMBAL  DEPTH  AT  CORNER 

*SET, D63 , 4 . 500  *  WIDTH  OF  PITCH  ARMS 

*SET, D65, 2 . 000  *  SPACE  BETWEEN  TOP/BOT  PLATE  AND  YAW  HUB 

*SET , D67 , 6 . 000  *  HALF  HEIGHT  AT  CORNER 

*SET , D68 ,6.000  *  HALF  HEIGHT  AT  PITCH  HUB 

*SET, D69, 60. 000  *  INSIDE  HALF  LENGTH 

*SET, D80, 48 . 000  *  INSIDE  HALF  LENGTH  TO  CORNER 

*SET , D7 1 , 3 . 9 3 7  *  RINGFEDER  OUTER  RADIUS 

*SET, D72 , 6 . 000  *  HALF  WIDTH  OF  PITCH  HUB 

*SET, D73 , 2 . 800  *  OUTER  GIMBAL  TO  INBOARD  PITCH  BEARING 

*SET, D74 , 5. 000  *  BEARING-BEARING 

*SET, D75, 3 . 000  *  PITCH  ACTUATOR  SHAFT  OUTER  RADIUS  UNDER 

RF 

*SET, D76, 2 . 000  *  SHAFT  WALL 

C***  CALCULATED 

*SET, D60 , 47 . 036  * 

*SET, D64 , 6 . 675  * 

*SET , D66 , 8 . 8  3 1  * 

*SET, D70 , 51 . 724  * 

CL 

C***  ELEVATION  BEARINGS 

*SET, PAX, 2E+07  *  1/2  HERTZIAN 

*SET, PRAD, 1E+07  *  1/2  HERTZIAN 

*SET, D77 , 1 . 000  *  BEAM  AREA 

*SET, D78 , 1 . 2667  *  BEAM  IYY 

C***  END  PARAMETERS 


INNER  PLATE  LOCATION  CL 
AZIMUTH  HUB  OUTER  RADIUS  CL 
MODEL  HEIGHT 

OUTER  PLATE  MODEL  LOCATION  AT  YAW  HUB 


/PREP7 

/TITLE,  PARAMETRIC  52T  ELEVATION  MODES  P52 

KAN,  2 
KAY ,2,5 
KAY ,3,5 

ET, 1, 63 
ET, 2 , 16 

ET, 3,21, , ,2 
ET,  4 , 4 

C***  DEFINE  COORDINATE  SYSTEMS 

K, 1001 
K, 1002 , 1 
K, 1003 ,  ,  1 
K, 1004  ,  ,  ,  1 

CSKP, 11, 1, 1001, 1003, 1004  *ROLL  AXIS 
CSKP, 12, 1,1001, 1004, 1002  *PITCH  AXIS 
CSKP, 13, 1, 1001, 1002, 1003  *YAW  AXIS 
CSYS 

c***  MATERIALS 

EX, 1 , 29E6  *STEEL 

DENS, 1, .00088 
NUXY, 1,  .  3 

EX , 2 , 1E7  * ALUMINUM 

DENS, 2 , . 0003 
NUXY, 2 , . 3 

EX , 9 , 10E6  * MASSLESS 

DENS, 9, 0 
NUXY , 9 , . 3 

EX ,3,2 6E6  *CAST  IRON 

NUXY, 3 , . 16 
DENS , 3 , . 0008 


The  geometric  data  is  omitted  for  brevity 

The  complete  P52F.DAT  file  is  on  disk  with  Professor  Brad 
Liebst 


C***  MIRROR  MODEL 
ESEL, REAL, 2,90 


B 


5 


EASE, REAL, 92, 99 

NELE 

CSYS 

SYMM, 3,1000, ALL 
EGEN ,2,1000, ALL 
ESEL, REAL, 2 , 19 
EASE, REAL, 21, 99 
NELE 

SYMM, 2, 2000, ALL 
EGEN, 2 , 2000, ALL 


0*** 

EALL 

NALL 

MERG ,  .  1 

WAVE 

CE , 1 , ,313, UX ,1,303, ROTZ , D53 
CE , 2 , , 1313, UX, 1,13 03, ROTZ, D53 
CE , 3 , ,2313, UX ,1,303, ROTZ , -D53 
CE , 4 , , 3313, UX, 1,1303, ROTZ, -D53 

M, 301, ROTZ 
M, 303 , ROTZ 
M, 1301, ROTY 
M, 1303 , ROTY 

TOTAL,  5 

C***  END  GAME 
CSYS 

C*** 

NALL 

EALL 

TOTAL, 100 
ITER, 1,1,1 

C***  RESTRAIN  PITCH  SHAFT 
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KD, 154 ,ROTY 
KD, 155 , ROTY 

C***  PITCH  BEARINGS 
CSYS , 12 
ESEL, REAL, 92 
NELE 

NRSE, X, 1, 111 

D, ALL, ALL 

EALL 

NALL 

CSYS 

AFWR 

FINI 

/INP, 27 

FINI 

/SHO , FILE3  3 , DAT , 1 

C***  RENAME  FILE 3 3 . DAT  AT  END  OF  RUN 
/POST1 

/TIT,  PARAMETRIC  MEDIUM  52T  MODES  P52 

SET, 1, 1 

/VIE, ,1,1,1 

/VUP, ,X 

/TYP, , 3 

EPLO 

/TYP 

SET, 1, 1 

PLDI , 1 

/VIE, , ,-l 

PLDI , 1 

/VIE, , , ,-l 

PLDI , 1 

/VIE, ,1,1,1 

SET, 1, 2 

PLDI , 1 

/VIE, , ,-l 

PLDI , 1 

/VIE, , , ,-l 

PLDI , 1 

/VIE, ,1,1,1 

SET, 1, 3 

PLDI ,  1 

/VIE, , ,-l 

PLDI , 1 

/VIE, , , ,-l 

Pr  nr  i 

UUX  f 

/VIE, ,1,1,1 
SET, 1,4 
PLDI , 1 
/VIE, , ,-l 
PLDI , 1 
/VIE, , , ,-l 
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APPENDIX  C;  MATLAB  PROGRAMS 


%  SCRIPT  FILE  LQGD.M 
% 

X  Calculates  closed  loop  LQG  for  colocated  and  non-colocated 
X  systems.  Also  calculates  LTR  and  closed  loop  bandwidths. 

X 

X  Must  have  the  following  matrices  available 

X  -  a,b,  co  (colocated  c  matrix),  cn(non_colocated  c  matrix) 

X  and  d  state  space  matrices. 

X  -  w,  the  frequency  values  from  LOGSPACE.M 

X  -  no,  the  noise  intensity  at  the  input 

% 

X  Inputs  are 

% 

X  Wc  and  Wn  =  diagmx(Q,R) 

X  Q.M  is  available  to  facilitate  inputing  the 

X  diagonal  weighting  matrix 

X  r  =  fictitious  noise  values  used  in  loop  transfer  recovery 

% 

X  This  program  assumes  V  =  Q0*eye(n)  matrix  for  Kalman 
%  filter  calculations.  Select  the  most  realistic  possible. 

% 

X  W.  C.  Lee,  1-1-91 
dim=size(a) ;dim=dim(l) ; 

[me ,pc ]=bode(a ,b,co,d , 1 ,w) ;  X  Bode  plots  of  the  open  loop  plant 

[mn , pn] =bode(a ,b , cn ,d , 1 , w) ; 

clear  k 

!del  graph. met;* 

for  i=l:100  X  Runs  the  menu  for  up  to  100  iterations 

if  (i~=l) 

k=menu( ’ LQGD  MENU ' , 'LQR  colocated  iteration ' , ' Continue  to  LTR  design ' , . . . 

' LQR  non-colocated ' ,  '  LTR  non-colocated  '  ,  'Comparison Exit ')  ;  end 

if  (k==6) 

disp('run  graphit  to  get  prints  from  this  session') 

X  clear  r  dfc  dfn  Bb  Bbn  Cb  Cbn  Db  Dbn  pcc  pc  pen  pn  MC  MN  sys 

%  clear  dim  xi  th  sek  seko  sekn  skeno  Ab  ABn  bfc  cfc  bfn  cfn 

return 

end ; 


%  COLOCATED  FULL-STATE  REGULATOR  DESIGN  ITERATION 


if  (k==l) 


Wc=input( ' input  Wc  ='); 
kc=lqrc(a ,b,Wc) ; 

skc=sigma(a-b*kc,  b,co,d,l,w);  %  Closed  loop  LQR 

loglog(w, me, w, skc) ,title([ 'Closed  loop  LQR  -  colocated  graph  # 
' , . . .  int2str(i )  ]  ) ; 

pause 

%meta  graph  %  puts  graphs  into  graph. met  for  later  printing 
end 


Z  LTR  DESIGN 


if  (k==2) 


sys- [a  b ; co  d] ; 

xi=no*eye(dim) ; th=l ;  Z  Select  xi  based  on  individual  problem 

skco=20*logl0( sigma(a ,b,kc ,d , 1 ,w) ) ;  Z  SV  for  open  loop  LQR 
r=input (' input  r  for  loop  recovery  =  '); 

[afc.bfe.cfc ,dfc ]=ltrin(sys ,dim,kc , xi , th,r ,w ,skco) ; 
kf-bf c ; 

Z  Closed  loop  K(s)G(s)  system 

Ab=[a  -b*kc:kf*c.o  a~b*kc~kf *co] ;  Bb=[b|b];  Cb=[co  zeros(co)];  Db=d| 
[mcc , pcc ]=bode( Ab, Bb ,Cb, Db , 1 ,w) ; 

%loglog(w, me ,w,mcc) ,title( [ 'Colocated  LQG  closed  loop  graph  # 
’,int2str(i)  ]  ); 

end 


Z  NON  -  COLOCATED  LQR  DESIGN  ITERATION 


if  (k==3) 


V’r.“input(  ' input  Wn  =  '); 
kcn=lqrc(a,b,Wn) ; 
skcn=sigma(a-b*kcn,  b,  cn,d,l,w); 

loglog(w,mn ,w,  sken) , title( [ 'Closed  loop  LQR  for  non-colocated 

graph  #  int2str(i)]  ); 

pause 

%  meta  graph 
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end 


%  NON-COLOCATED  LTR  DESIGN 


if  (k==4) 


sys-[a  b;cn  d]  ,* 

xi=no*eye(dim) ; th=l ;  %  select  xi  based  individual  problem 

skcno=20*logl0(sigma(a ,b ,kcn ,d , 1 ,w) ) ; 
r=input (' input  r  for  loop  recovery  =  '); 

f afn , bfn ,cfn,dfnj=ltrin(sys , dim, ken , xi , th, r ,w, skeno) ; 
kf n=bf n ; 

Aun=[a  -b*kcn;  kfn*cn  a-b*kcn-kfn*cn] ;  Bbn=[b;b];  Cbn=[cn 
zeros (cn)  ]  ; 

Dbn=d ; 

[men ,pcn]=bode(Abn,  Bbn,  Cbn ,Dbn , 1  ,w)  ; 

%loglog(w,mn ,w,mcn) ,title( [ 'Non-Colocated  LQG  closed,  graph  #  ' ,int2str(i) 

]  ): 

end 


X  Compare  closed  loop  bandwidth 


if  (k==5) 

MC=20*logl0(mcc/mcc(l)  );  MN=20*logl0(mcn/mcn( 1 )  ); 
wl=[min(w)  max(w)]; 

semi logx(w,MC, ' - ' ,  w,MN,  '  — '  ,wl ,-3*ones (wl) ,wl , 60*ones(wl) )  title ( ' 
BODE  PLOT'); 

xlabel ( ' FREQ  (Rad/Sec)  '  ) 
ylabel( 'MAG  dB ' ) 
text( .2, .3, 'KEY' , 'sc' ) 

text(.15,.26,' colocated  " _ "  '  ,  '  sc  '  ) 

text ( . 15 , . 23 , 'non-colocated  " - "  ','sc') 

pause 

meta  graph 

end 

end  X  goes  with  for  i=l:100  on  top 


C  -  3 


LTRIN.M 


function  [af ,bf , cf ,df , svl ]  -  ltrin(sys ,dim,Kc ,xi , th, r ,w, svk) 

Z  My  modified  LQG/LTR  program  to  calculate  loop  transfer  recovery 
%  and  compare  open  loop  SV  for  LQR  and  LTR 
% 

Z  [af ,bf , cf ,df , svl ]  =  ltrin(sys ,dim,Kc , xi , th, r ,w, skc) 

% 

Z  LQG/LTR  at  inputs  of  the  plant,  such  that  the  LQG  loop  TF 
Z  will  converge  to  LQSF's  loop  TF  as  the  plant  noise  goes  to  INF: 

%  -i  -1 

Z  GKc(Is-A+B*Kc+Kf*C)  Kf - >  Kc(ls-A)  B  (as  r - >  INF) 

% 

%  Inputs:  sys  —  system  matrix, 

Z  dim  —  no. of  states 

%  Kc  —  LQR  gain, 

Z  skc  —  SV  of  (Kc  inv(ls-A)B)  ***  Must  be  input  as  dB  *** 

Z  w  —  frequency  points  (rad/sec) 

Z  xi  —  plant  noise  intensity,  taken  as  identity 

%  th  —  sensor  noise  intensity,  taken  as  identity 

%  r  —  a  row  vector  containing  a  set  of  recovery  gains 

% 

%  Outputs:  svl  —  singular  value  plots  of  all  the  recovery  points 
Z  (af ,bf , cf ,df )  —  final  state-space  controller 

Z  where  bf=Kf  and  cf=Kc 

o/ _ _ _ _ _ _ _____ _ ® 

70 - —  — — - - -  - -  /o 


nq  =  length(r); 

[A,B,C,D]  r  sys2ss(sys ,dim) ; 
[md,nd]  =  size(D) ; 


for  i  -  1 :nq 
disp( '  ' ) 

disp(['  LQG/LTR  - >  recovery  gain  =  '  num2str (r( 1 , i ) )  ’ 

xi  =  xi  +  r(l,i)*B*B'; 
qrnc  =  diagmx( xi , th) : 

Kf  =  lqrc(A' ,C ' ,qrnc) ; 

Kf =Kf ’  ; 

af  =  A  -  B*Kc  -  Kf*C! 
bf  =  Kf; 
cf  =  Kc; 
df=D; 

Z  df  =  zeros(size(Kc)*[ 1 ;0] ,size(Kf )*[0; 1] ) ; 

[al , bl , cl ,dl ]  -  series(af ,bf ,cf ,df ,A,B,C,D) ; 
sv  =  sigma(al ,bl , cl ,dl , 1 ,w) ;  sv  =  20*logl0(sv) ; 
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if  i  ==  1 

svl  =  sv; 

else 

svl  =  [svl ;sv] ; 

end 

end  X  for  1=1 :NQ 


semi logx(w,svk,w, svl) 

title( 'LQG  with  LTR ' ) 

xlabel( 'FREQUENCY  (  Rad/Sec  )') 

ylabel ( ' SV  dB') 

text (. 17 88 target  full-state  open  loop  ','sc') 
pause 

meta  graph 


disp( ' ( run  graphit  to  get  print.  Sent  to  LN03)') 
% 

% - End  of  LTRY.M  —  RYC 
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ROOTPLOT . M 


function  r-rootplot (a ,b , c ,d ,  kc ,kf .alpha .zero) 


X  ROOTPLOT  R-Rootplot (A, B ,C,D,Kc ,Kf , alpha , zero) 

X 

X  alpha  -  gains  on  the  output  matrix  c 

X  zero  -  the  zeros  from  tzero  with  large  ones  omitted 

% 


% 

X 

X 

X 

X 

X 

X 

X 

X 

X 

X 

X 


Same  as  RLOCUS  except  that  the  roots  are  automatically 
plotted  and  crosshairs  appear  for  determining  the  gain 
corresponding  to  a  desired  closed  loop  pole  location. 

Once  the  crosshairs  are  positioned  near  a  pole  on  the 

screen,  hitting  carriage  return  results  in  the  calculation 
and  display  of  the  gain  corresponding  to  the  nearest 
closed  loop  pole.  In  addition  all:  the  closed  loop  poles, 
their  natural  frequencies  and  damping  factors 
corresponding  to  that  gain  are  displayed. 

B.S.  Liebst,  6-1-88 
W.  C.  Lee,  1-1-91 


poles=eig(a) ; 
pr  =  real (check( poles ) ) ; 
pi  =  imag( check (poles) ) ; 
zr^realCzero) ; 
zi=imag(zero) ; 

r=[]; 

if (nargin==8) ; 

for  i=l : length(alpha) 


cs tar-alpha ( i )*c ; 

abig=[a  -b*kc  ;kf  *cstar  a-b*kc~kf *c ] ,' 

rt=eig(abig) ; 
r= [ r ; rt  ’  ] ; 


end 


else 

error( ' Incorrect  number  of  input  arguments') 
end 


j-sqrt(-l) ; is-0;km-l ; 

plot ( real ( r ) ,imag(r) , ' . ' ,pr ,pi , ' x ' , zr , zi , ' o ' ) 
t i t 1 e ( ’  ROOT  LOCUS' ) 
xlabel ( 'REAL  AXIS’ ) 
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NOISE. M 


function  [Qx ]-noise(a ,b, c ,kc ,kf ) 

%  NOISE  [Qx]  =  noise(a , b , c ,kc ,kf ) 

% 

%  Solves  the  Lyapunov  equation  for  output  noise  RMS  value 

% 

%  AX  +  XAT  +  BVBT  =  0 

% 

%  assumes  that  V  is  identity 

% 


Ab-[a  -b*kc;kf*c  a-b*kc  -kf *c ] ;  %  Closed  loop  K(s)G(s)  system 

Bb= [ zeros (kf ) ;kf  ] ; 

X=lyap(Ab ,Bb*Bb ' ) ; 
diag(X) 

Cb= [ c  zeros ( c ) ] ; 

Qx=Cb*X*Cb' ; 
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STEPP.  M 


function  stepp(a,b,co,cn,d,kc,kcn .time , type ) 

%  STEPP  stepp(a ,b, co , cn ,d ,kc , ken , time , type) 

% 

%  Calculates  step  response  for  closed  loop  full-state  regulator 

%  time  needs  to  be  in  small  enough  steps  to  cover  the  poles 

% 

%  type  =  1  plot  normalized  to  steady  state  value 

%  type  =  2  plot  normalized  to  max  value 


!del  graph. met;l 

Ycrstep(a-b*kc , b , co ,d , 1 .time ) ; 

Yn=step(a-b*kcn ,b , cn ,d , 1 .time ) ; 

w=[min(time)  max(time)],'  %  set  length  for  faster  plotting 

if  (type==l) 

Yc=Yc/Yc(length(Yc) ) ; 

V :;  =  Yn/Yn(  length (Yn) ) ; 

pi (  t ( time ,Yc , time ,Yn ,w, 2*ones (w) ,  w,  .95*ones(w) , 
w. 1 ,05*ones(w) ,  ' : ' ) 

%  meta  graph 
%  pause 


end 

if  (type==2) 

Yc=Yc/max( Yc ) ; 

Yn- Yn/max(Yn) ; 

plot(time,Yc,time,Yn,w,.95*ones(w), ' : ' ,w,l ,05*ones(w) 
w,-.2*ones(w) ) 

meta  graph 

end 

t i t 1 e ( 'STEP  RESPONSE' ) ; 
xlabel (  i iMt  (sec)'); 
ylabel( 'DISPLACEMENT  y') 
text( .7, .3, 'KEY' ,  'sc') 

text ( . 65 , . 26 , ' colocated  " _ "  ' , ' sc  ' ) 

text( .65, .23, ' non-co located  " - " ' ,  '  sc ' ) 

meta  graph 
pause 

disp('run  graphit  to  get  prints') 
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